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Abstract 


This  study  develops  a  computer  program  for 
interactive  execution  to  aid  in  the  design  of  Command 
Generator  Tracker  control  systems  employing  Proportional 
Plus  Integral  inner  loop  controllers  based  on  the  integral 
of  the  regulation  error  and  Kalman  Filters  for  state 
estimation  (CGT/PI/KF  controllers) .  Sampled-data  controller 
designs  are  based  upon  the  Linear  system  model.  Quadratic 
cost,  and  Gaussian  noise  process  (LQG)  assumptions  of 
optimal  control  theory. 

The  report  develops  the  CGT/PI/KF  controller  theory 
with  the  PI  controller  portion  based  upon  the  integral  of 
the  regulation  error.  Following  a  brief  description  of  the 
computer  program  developed,  results  of  applying  it  to  an 
example  aircraf t-related  controller  design  problem  is 
presented.  The  CGT/PI/KF  controller  is  found  to  be  a 
technique  particularly  well  suited  to  the  aircraft  control 
design  problem  but  is  a  technique  that  may  be  applied  to  any 
general  controller  problem  fitting  the  design  criteria. 

Use  of  the  computer  program  is  fully  documented  in 

the  appendices  of  the  report.  Included  are  a  brief 

o  9"  r 

^"■programmer's  Manual,  a  complete  "User's  Manual",  and  a 

program  listing.  These  pertain  to  the  computer  program  as 
implemented  on  a  CDC  CYBER  computer  system. 
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COMMAND  GENERATOR  TRACKER  SYNTHESIS  METHODS 
USING  AN  LQG-DERIVED 
PROPORTIONAL  PLUS  INTEGRAL  CONTROLLER 
BASED  ON  THE  INTEGRAL  OF  THE  REGULATION  ERROR 

I .  I ntroduction 


1.1  Background 

The  earliest  flight  control  designs  served 
exclusively  as  a  pilot  relief  function.  It  was  much  later 
before  control  systems  were  designed  to  improve  aircraft 
stability,  but  these  still  had  limited  control  authority. 
Furthermore,  such  systems  were  designed  in  a  trial  and  error 
evolutionary  fashion. 

Current  and  future  aircraft  designs  require 
increasingly  complex  controls.  These  newer  aircraft  employ 
digital  flight  control  systems  in  order  to  meet  complex 
performance  specifications.  The  typical  aircraft  control 
design  problem  is  one  in  which  measurement  data  from  many 
sensors  are  input,  and  signals  to  multiple  control  surfaces 
and  actuators  are  output.  These  multiple- input/multiple- 
output  control  systems  are  required  to  respond  to  commanded 
inputs  while  simultaneously  rejecting  disturbances. 

There  are  typically  two  general  approaches  to 


solving  the  problems  of  flight  control.  The  oldest  and  most 
widely  used  and  accepted  is  the  classical  design  technique. 
The  other  technique  is  the  "modern  control"  design.  Despite 


the  systematic  nature  and  performance  potential  of  the 
modern  control  design  technique,  this  method  has  not 
supplanted,  or  even  complemented  to  the  degree  originally 
anticipated,  the  classical  control  methodology.  This  is  due 
in  part  to  numerous  deficiencies  in  initial  applications  of 
modern  control  design  techniques.  These  deficiencies 
include:  (1)  traditional  design  criteria  were  not  readily 

specified  directly  in  the  performance  index,  (2)  it  was 
difficult  to  select  appropriate  weighting  matrices  for  the 
cost  functionals  to  ensure  desired  response,  (3)  the 
resulting  controllers  required  full-state  feedback,  but 
direct  perfect  measurements  of  all  states  are  never 
available— thus  requiring  approximations  or  insertion  of 
filters  or  observers  before  implementation,  and  (4)  the 
original  formulation  of  the  optimal  controller  solved  only 
the  regulator  problem  and  not  the  required  tracking  response 
to  the  command  inputs. 

To  make  modern  control  design  techniques  more 
applicable,  a  synthesis  method  known  as  model  following, 
including  implicit  and  explicit  model  following,  has  been 
used.  Recent  developments  in  modern  control  theory  have 
been  unified  into  a  new  synthesis  technique  known  as  command 
generator  tracking  (CGT) (Refs  2;  3;  4;  and  18:151-166).  In 
this  methodology,  one  requires  a  system  to  respond  to 
command  inputs  while  rejecting  disturbances,  so  that  the 
states  of  the  system  maintain  desired  trajectories  in  real 
time.  Both  the  desired  trajectories  and  the  disturbances 
are  formulated  as  the  outputs  of  linear  system  models.  The 


first  of  these,  the  command  generator  model,  can  produce  a 
time  history  of  variables  that  the  actual  system  is  to 
follow  or  mimic,  thereby  incorporating  handling  qualities 
into  the  controller  design  (Refs  10  and  16) . 

In  an  open  loop  format,  the  problem  is  to  determine 
appropriate  gains,  from  the  states  of  both  the  command 
generator  model  and  the  disturbance  model  or  shaping  filter 
(Ref  17:180-186)  to  the  system  control  inputs  (also  to 
determine  appropriate  inputs  to  those  models),  that  will 
yield  command  generator  tracking;  i.e.  replication  by  the 
actual  system  of  the  desired  output  responses  despite  any 
modelled  disturbances.  If  the  original  system  is  unstable 
or  marginally  stable,  or  affected  by  unmodelled  disturbances 
and  uncertainties,  the  addition  of  stabilizing  feedback  is 
required.  The  feedback  controller  should  produce  a  system 
with  la  type-1  property  to  ensure  the  system  will  respond 
with  zero  steady-state  error  to  a  step  input,  since  a  more 
complex  input  can  be  approximated  by  a  series  of  step 
inputs.  Thus  the  consideration  of  a  proportional  plus 
integral  (PI)  design  is  appropriate  for  the  feedback 
controller,  since  it  can  provide  this  type-1  property  (Refs 
5;  6;  and  18:132-151).  PI  design  based  on  augmenting  the 
original  state  equations  with  difference  equations  for 
control  variables,  treating  control  pseudorates  as  driving 
functions,  has  already  been  exploited  (Refs  9;  19;  and  21). 
It  has  also  been  shown  that  analogous  PI  controllers  can  be 
obtained  by  augmenting  the  original  system  states  with  the 
integrals  of  regulation  error  (Ref  18:135-141).  Finally, 


since  perfect  access  to  all  system  state  variables  is  rarely 
available,  sensor  outputs  must  be  processed  by  a  Kalman 
filter  (KF)  or  observer  to  generate  estimates  of  the  state 
variables  (Ref  17:203-406).  The  resulting  controller  is 
known  as  a  CGT/PI/KF  controller. 

To  date,  two  efficient  interactive  computer  software 
programs  have  been  developed  for  the  design  and  performance 
analysis  of  CGT/PI/KF  controllers.  The  first  software 
program,  known  as  "CGTPIF"  developed  by  Capt.  Floyd  (Ref  9) 
and  later  modified  by  Lt.  Moseley  (Ref  21) ,  specifically 
aids  the  user  in  conducting  the  synthesis  and  analysis  of 
the  components  of  the  CGT/PI/KF  controller.  The  second, 
"PFEVAL"  developed  by  Lt.  Moseley,  conducts  a  statistical 
performance  analysis  of  the  resulting  composite  controllers 
(Ref  21) .  "CGTPIF"  currently  bases  the  design  of  the  PI 
controller  only  on  the  difference  equations  for  control 
variables,  but  since  some  designers  may  be  more  familiar 
with,  or  have  a  better  feel  for,  designing  the  PI  controller 
based  on  the  integral  of  the  regulation  error,  the  need  for 
this  type  analysis  tool  exists. 


1.2  Problem  and  Scope 

The  primary  objectives  of  this  thesis  are: 

1.  To  develop  an  interactive,  user-oriented 
computer  program  similar  to  "CGTPIF" ,  which  will  also 
interface  with  "PFEVAL",  to  aid  in  the  design  of  CGT/PI/KF 
controllers,  basing  the  design  of  the  PI  controller  on  the 
integral  of  the  regulation  error. 


2.  To  apply  the  design  program  >  an  aircraft 


flight  control  problem  to  evaluate  characteristics  of  this 
CGT/PI/KF  controller  design  and  to  compare  the  designs. 

1.3  Sequence  of  Presentation 

The  results  of  this  effort  are  fully  documented  in 
the  body  of  the  thesis  and  in  the  appendices.  Chapter  II 
contains  a  short  overview  of  the  existing  work  performed  in 
the  previous  two  theses  (Refs  9  and  21),  with  the 
theoretical  aspects  of  the  alternate  PI  controller  design 
techniques  presented  in  Chapter  III.  Chapter  IV  presents  a 
description  of  the  computer  program  developed  for  the 
alternate  PI  controller  designs  as  well  as  summarizing  the 
pertinent  information  from  the  existing  "CGTPIF"  program. 
Chapter  V  discusses  and  compares  the  PI  controller  designs 
through  use  of  the  program.  A  final  chapter  offers 
conclusions  and  recommendations  for  further  research. 

There  are  four  appendices  to  this  thesis.  The  first 
is  a  brief  description  of  the  computer  program  subroutines 
that  were  changed  in  going  from  "CGTPIF"  to  the  alternate 
program  called  "CGTPIQ".  For  a  complete  program  analysis, 
the  reader  of  this  thesis  must  also  read  Floyd's  and 
Moseley's  theses  (Refs  9  and  21),  especially  if  the  plan  is 
to  understand  all  the  computer  program  subroutines  with  the 
idea  of  modifying  the  program  in  any  way.  The  second  is  a 
complete  user's  guide  for  "CGTPIQ".  The  third  is  a  full 
source  listing  of  the  computer  code  and  the  fourth  is  a 
summary  of  the  CGT/PI/KF  design  evaluation  for  CGTPIQ. 


2.1 


Introduction 


The  control  philosophy  employed  in  the  CGT/PI/KF 
controller  is  not  new.  While  it  is  clearly  in  the  class  of 
model** following  controllers  and  has  characteristics  closely 
related  to  those  typical  of  the  earlier  model-following 
designs,  the  theory  from  which  it  is  derived  is  distinctly 
not  in  a  linear  path  with  earlier  work.  In  one  consistent 
development  it  incorporates  all  the  capabilities  of  earlier 
model-following  designs,  provides  new  capabilities,  and  does 
so  in  a  single  unified  controller/filter  structure. 

The  basic  structure  of  this  controller  is  as 
depicted  in  Fig.  II-l.  It  accepts  command  inputs  and 
generates  a  feedforward  control  through  the  command 
generator  model  and  CGT  controller;  it  incorporates  a  PI 
controller  as  an  inner  loop  feedback  controller  to  drive  the 
system  to  follow  the  CGT  inputs;  and  it  uses  a  Kalman  filter 
to  provide  estimates  of  both  the  system  and  disturbance 
states  needed  by  the  controllers. 

Before  presenting  the  theoretical  development  of  the 
alternate  PI  controller  (Chapter  III),  the  rest  of  this 
chapter  will  introduce  the  CGT/PI/KF  controller  concept  by 
briefly  summarizing  what  is  currently  implemented  in  the 
interactive  computer  programs  "CGTPIF"  and  "PFEVAL".  This 
chapter  is  taken  in  part  from  a  paper  by  Maybeck,  Floyd,  and 


» 


Pig.  II-l.  CGT/PI/KF  General  Block  Diagram 


Moseley  {Ref  19)  which  presents  this  concept  in  a  tutorial 
manner.  The  development  presented  in  Chapter  III  will  be 
constructed  in  a  linear  path  with  "CGTPIF"  and  will 


interface  directly  with  "PFEVAL".  It  is  recommended  that 
the  reader  of  this  thesis  also  read  the  preceding  theses 
(Refs  9  and  21)  to  obtain  a  more  thorough  overall  picture  of 
the  problem. 

2.2  Command  Generator  Tracking 

Consider  a  system  described  by  the  linear  time 
invariant  discrete  time  model 

5(ti+l)  “  +  Bdu(t.)  +  ?x-d ( ti)  +  *(ti} 

^(tj)  *  9*(ti}  +  5yu(ti)  +  Synd(t.)  (II-2 ) 

where  xtt^)  is  the  state  at  sample  time  t^, 
utt^  is  the  control  applied  to  the  system  at  time 
fcif  Od^P  *s  a  vector  of  time  correlated  noises 
and  disturbances,  wttj)  is  zero-mean  white  Gaussian 
dynamics  driving  noise  of  covariance  Q,  and  y  (t.) 
is  a  vector  of  output  controlled  variables  over  which  we 
want  to  exert  influence  and  to  cause  to  behave  in  a 
desirable  manner.  Such  a  model  can  be  established  by 
writing  the  continuous  time  linear  perturbation  equations 
for  a  system  (such  as  an  aircraft)  and  then  generating  the 
equivalent  discrete  time  model  at  a  chosen  sample  rate  (Refs 
17  and  18).  This  model  is  assumed  to  be  stabilizable  and 
detectable  (Ref  18).  In  Equations  (II-l)  and  (II-2) 


is  a  vector  o£  disturbances  whose  effects  on 
the  system  we  specifically  want  to  reject,  and  it  is 
modelled  as  the  output  of  a  shaping  filter  of  the  form 


fid(ti+l>  *  +  S„Sdn(tt> 


(II-3) 


where  w^tt^)  is  a  zero-mean  white  Gaussian  noise  of 
covariance  Qn  that  is  independent  of  w(t^)  in 
Equation  (II-l).  It  is  desired  that  the  system  described  by 
these  equations  duplicate  as  closely  as  possible  the  output 
of  a  command  generator  model 


*  SmW  +  Sm»mUi> 
ym(ti>  ’  CmW  +  8n»m(ti> 


(II-4) 

(II-5) 


where  the  model  input  y^tt^)  can  be  viewed  as  the 

desired  input  (such  as  provided  by  the  pilot  stick) ,  and 

this  model  specifies  the  system's  desired  dynamic 

characteristics.  Although  x^t^)  and  y^ft^ 

need  not  be  of  the  same  dimension  as  xtt^  and  utt^ 

of  Equation  (II-l) ,  ym(t^)  *s  the  same  dimension 

as  £c(tp  E<3uation  (II-2).  For  controller 

development,  it  is  assumed  that  u^t^)  is  a 

constant,  um.  In  actual  applications  it  typically 

varies  very  slowly  relative  to  the  chosen  sample  period,  and 

um  can  thus  be  considered  piecewise  constant  with  long 

intervals  of  essentially  constant  value.  Since  um  is 

generally  nonzero,  a  PI  controller  will  be  more  desirable 


than  a  simple  regulator  for  feedback,  to  enable  achieving 
the  desired  values  with  zero  steady  state  mean  error.  This 
will  be  pursued  in  the  next  section. 


Mathematically,  the  objective  of  the  CGT  is  to  force 
the  error  between  the  actual  system  output,  y  »  and  the 
desired  (model)  output,  ym,  to  zero: 


e(ti)  -  yc(ti)  -  3f«(ti)  -  0 


(II-6 ) 


Assume  initially  that  x(t^),  nd(t^),  and 

y c ( t ^ )  are  all  perfectly  accessible,  to  be  replaced 

later  by  Kalman  filter  estimates.  Thus,  the  ideal  state  and 

control  trajectories,  Xjtt^)  and  Ujtt^  for 

all  t^,  are  defined  as  the  time  histories  the  system 

states  and  controls  must  follow  so  that  the  true  system 

output  perfectly  matches  the  model  output,  as  in  Equation 

(II-6);  while  the  system  is  being  affected  by  modelled 

disturbances: 


XlUi+l)  *  fXjft^  +  BUjttj^)  +  lxnd(ti) 


(II-7) 


t 


Another  requirement  levied  on  the  ideal  trajectories  is  that 
they  must  be  linear  functions  of  xm(t^), 

am(ti}  and  Sd(ti)! 


"a i  ( t i)"  -  Ta 
uI(til  - 


^11  -12  -13| 


21  -22  ^23. 


ll  *m(ti] 

J  V*!1 


aa(ti> 


(II-8) 


1 1-5 


The  CGT  problem  is  then  to  solve  for  the  matrix  partitions 
in  Equation  (II-8)  such  that  Equations  ( 1 1— 6 ) ,  (II-7),  and 
( I 1—8 )  are  all  satisfied.  This  will  be  shown  in  Chapter  III 
(Section  3.3.1).  Once  these  evaluations  are  accomplished, 
the  CGT  control  law  is  implemented  simply  as  the  lower 
partition  of  Equation  < I I— 8 ) s 

Sl(ti>  ’  &2lS»(tt>  +  +  &23Ba(ti>  I11'9* 

2.3  PI  Controller 

Now  consider  the  PI  controller  of  Fig.  II-l.  One 
seeks  a  controller  structure  that  includes  accepting  the 
sensed  error  between  ^m(t^)  and  achieved 
yc(ti) t  and  generating  the  appropriate  control  to 
feed  back  into  the  system  to  keep  this  difference  small.  To 
keep  the  system  in  a  nonzero  equilibrium  condition  such  that 
steady  state  error  is  zero,  the  controller  fed  by  the 
regulation  error  C t ^ )  -  2c^fci^  must  be 

able  to  deliver  the  appropriate  nonzero  steady  state  control 
when  its  own  input  is  zero.  This  cannot  be  achieved  by  a 
simple  proportional  feedback  regulator,  and  so  a  PI 
controller  is  motivated.  This  form  of  controller  will  also 
be  able  to  reject  the  effect  of  unmodelled  constant 
disturbances  (as  due  to  generating  controller  designs  based 
on  linear  perturbation  models  expanded  about  a  particular 
point  in  the  operational  envelope  of  the  vehicle,  while  the 
vehicle  is  actually  operating  at  a  somewhat  different 


point) ,  which  is  also  highly  desirable  in  this  application. 


In  this  section,  perfect  access  to  all  states  and 
pertinent  variables  is  again  assumed,  and  the  Linear  system. 
Quadratic  cost,  Gaussian  noise  (LQG)  synthesis  technique 
will  be  used.  This  methodology  provides  a  systematic 
synthesis  procedure  to  generate  a  controller  with  desired 
stability  properties  ensured,  in  which  the  appropriate  cross 
feeds  in  this  multiple  input/multiple  output  controller 
(whose  evaluation  may  not  be  very  apparent  from  other  design 
techniques)  are  dictated  by  system  and  cost  descriptions, 
and  in  which  tradeoffs  between  state  and  control  amplitudes 
can  be  readily  accomplished  in  the  design  process. 


2.3.1  PI  Controller  Based  on  Control  Difference  Equations 


One  means  of  developing  a  PI  controller  for  this 


application  is  to  consider  the  perturbation  variables 


«/'Jj(ti)  *  xtt^  -  SI(ti) 
✓uttj.)  »  u(t.)  -  ttjUi) 
<fic(tl)  "  *c(tl>  -  W 


(II-10a) 

(II-10b) 

(II-lOc) 


In  terms  of  these  variables,  perturbations  about  the  ideal 
trajectories  can  be  described  by  the  augmented  perturbation 
state  equation 


Vx(ti+1)*  -  '*  Bd  J'i(tjL)  +  Q  AiiUj) 

/“(ti+l>J  “  U  ij  L'kvJ  Ia 


!K 


■r 


I 


s- 
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where  the  upper  partition  is  the  perturbation  equation 
associated  with  the  system  and  the  lower  partition  treats 
/ii(t^)  as  additional  states  by  considering  them  as  the 
output  of  a  summation  (pseudointegration)  process 

/y  {ti+i}  a  JuUj)  +  Ay.(t.)  (11-12) 


in  terms  of  control  differences  or  "pseudorates".  For  this 
augmented  perturbation  system  description,  an  optimal 
constant  gain  controller  to  minimize  the  quadratic  cost 
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can  be  efficiently  generated  via  solution  to  steady  state 
(algebraic)  Riccati  difference  equations  (Ref  13). 
specifies  the  cost  weighting  on  state  magnitudes,  X.22  on 
control  magnitudes,  and  y  on  control  differences.  The 
solution  form  for  this  controller  problem  is 


Aa*(t.) 


±) 

/u(ti) 


(11-14) 


* 

In  terras  of  the  controller  gains  Sc^  and 

* 

Sc2  ,  the  final  incremental  PI  control  law  can  be 
written  as  (Ref  18:145) 


II-8 


(11-15) 


a(ti)  -  u ( t i_i )  -  -  3l( t i—1 ) ] 


where  K  and  K  are  given  by 

— X  <t 


*x  3  SciVu  +  Sc2V21 

-z  =  -cl  ^12  +  -c2  -22 


(II-16a) 

(II-16b) 


with 
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221 

Is* 

to 

(i-i)  ad 

c  D.,  (11-17) 


which  will  be  developed  further  in  Chapter  III. 

2.3.2  Closed  Loop  CGT/PI  Controller  Based  on 
Control  Difference  Equations 
Without  going  into  any  detail  as  to  its  development, 
the  incremental  closed  loop  CGT/PI  controller  equation  based 
on  the  control  difference  (as  currently  implemented  in 
"CGTPIF")  will  be  shown  here.  After  reading  Chapter  III, 
the  reader  should  refer  back  to  this  section  to  see  the 
similarities  in  the  two  CGT/PI  control  laws.  The  law  is 


u  ( t  ±)  =  u(ti_1)  -  -  jlU^)] 

+  -z{  ^-m  em3  pm(ti_1)“|  -  [fi 

am(ti) 


ey]  [*(*!-!> 


+  l*Al  +  “  ^m(ti-in 

+  [-x-12  +  ^22]  [um(ti)  "  um(ti-l)1 
+  x— 13  +  ^231I^d(ti)  “  ^d(ti-in  Ul-18) 


Issues  such  as  speedup  and  initial  conditions  will  be 
addressed  in  Chapter  III  and  are  applicable  to  Equation 
(11-18) .  (The  full  development  is  presented  in  Refs  9  and 
18:135-147) . 


2.4  Kalman  Filter 

The  previous  sections  developed  controllers  under 
assumption  that  perfect  access  to  all  states  is  available  at 
each  sample  time.  Since  this  is  generally  not  the  case,  a 
Kalman  Filter  is  used  to  generate  optimal  estimates  of  these 
states  from  the  incomplete  noise  corrupted  outputs  of 
physical  sensors.  Certainty  equivalence  (Ref  18)  under  the 
LQG  assumptions  yields  the  optimal  controller  as  the 
controllers  presented  previously,  but  with  x(t^)  and 
rjd ^ i )  replaced  by  the  estimates  provided  by  the 


filter. 


The  dynamics  model  upon  which  the  filter  is  based  is 


generated  by  augmenting  Equations  (II-l)  and  (II-3)  to  get 
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and  the  measurement  devices  are  modelled  by 


z (t±)  =  [H  H^l 


£  (tj)  ' 
nd(ti> 


+  v(t.) 


(11-20) 


where  v  is  zero  mean  white  Gaussian  noise  of  covariance  Ft, 
independent  of  w  and  *  From  these  models,  a  standard 
Kalman  filter  (or  observer)  can  be  derived  and  implemented 
in  the  constant-gain  steady  state  form  to  accept 
measurements  and  produce  Stt^*)  and 

2d(ti+)'  as  shown  in  Fi9»  H-1.  In  the  CGT/PI 
control  law,  ^c(t^)  *s  rePlac«d  by 
^c(t^+)  in  Equation  (11-16)  where  from  Equation 
(II-2) 


iC(ti+)  »  Qii  t.  +  )  +  ^(t.)  +  ^(t^)  (II-2D 

2.4.1  CGT/PI/KF  Control  Law  Based  on  Control  Difference 
Equations 

The  Kalman  filter  outputs  can  be  combined  with  the 
CGT/PI  control  law  to  produce  a  CGT/PI/KF  control  law.  The 
development  of  this  law  is  thoroughly  documented  in  Lt. 
Moseley's  thesis  as  part  of  "PFEVAL"  and  is 


u(t.)  -  -  Kx(I-KH)x(t.  )  -  KSnnd(t.  )  +  Ka(t.) 

+  «Al  +  *21*  W 

+  tKxA13  +  A23]  t-KnHx(t.“)  + 

+  Knz{ti)  +  K?f(ti)  (II-22a) 
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and  where  the  Kalman  filter  gains  are  given  by 
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2.4.2  Implicit  and  Explicit  Model  Following 
Based  on  Control  Difference  Equations 
A  modification  performed  by  Lt.  Moseley  and 
documented  in  his  thesis  was  to  add  implicit  model  following 
to  the  explicit  model  following  of  the  "CGTPIF"  program.  In 
implicit  model  following ,  the  model  is  incorporated  into  the 
performance  index  and  thus  helps  determine  appropriate 
feedback  gains  so  that  deviations  in  achieved  transient 
response  from  the  desired  model  response  are  penalized 
mathematically,  and  thus  minimized  operationally.  In 
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Y  \Yv' 


explicit  model  following,  the  model  is  used  not  only  to 
determine  appropriate  feedback  gains,  but  also  feedforward 
gains  on  the  model  states  themselves,  thereby  requiring  an 
explicit  simulation  of  the  model  dynamics  in  the  controller 
itself.  (For  a  thorough  explanation  of  implicit  and 
explicit  model  refer  to  Capt.  Floyd's  thesis  (Ref  9),  which 
very  adequately  summarizes  the  available  literature  on  the 
subject.) 

The  result  of  adding  implicit  model  following  was  to 
change  the  weighting  on  the  x  vector,  with  x  defined  as  in 
Equation  (11-11)  as 


(11-24) 


from  weights 


x  -  rx1]L  X12 


‘•12  *22 


(11-25) 


as  in  Equation  (11-13) ,  to 


£  -  *n  +  xx 

X  T  +  3  T 
.-12  -I 
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*22  +  &i 


(11-26) 


where  (Ref  18:68-82) 


Xn  -  Q  XQ 


(II-27a) 
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PW 


(II-27b) 


(II-27c) 


in  terms  of  a  quadratic  weighting  matrix  Y  on  /^c  and  a 
weighting  matrix  on  /u  in  an  original  cost  function 
definition  convenient  for  a  designer's  use,  and  (Ref  9  and 
21) 


XT  *  (CA  -  AC)  TX_  (CA  -  AC)  (II-28a) 

—I  — —  — m—  —i  —  — m- 

StT  =  BTCTXt(CA  -  A  C)  (II-28b) 

—  i  —  —  —i  —  -m- 

Sj  =  Uj  +  B^XjCB  (II-28C) 

A 

(These  same  relations  for  X^,  —22'  -12 r 

A  A 

Uj  will  appear  in  Chapter  III  for  the  alternate 
derivation  of  the  PI  controller  based  on  the  integral  of  the 
regulation  error  but  the  placement  within  the  overall  matrix 
will  change.  The  reader  may  wish  to  refer  back  to  this 
section  after  reading  Chapter  III.) 


2 .5  Performance  Evaluation 

It  is  desired  to  use  the  previous  systematic 
controller  design  method  for  realistic  applications  in  which 
online  computer  limitations  such  as  speed  and  memory  size 
are  important  constraints  on  the  design.  Thus,  the  system 
models  used  for  controller  design  are  purposely  reduced 
order,  reduced  complexity  models.  A  number  of  prospective 
CGT/PI/KF  controllers  can  be  developed,  differing  in  state 
dimension,  choice  of  states,  complexity  of  defining 
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matrices,  performance  index  weighting  matrices,  and  filter 
tuning  parameters. 


For  these  CGT/PI/KF  controllers,  or  any  other 
digital  controllers,  it  is  desirable  to  conduct  a 


performance  analysis  as  depicted  in  Fig.  II-2.  The  truth 
model  portrays  the  actual  system  to  be  controlled  and  the 
effects  of  the  external  environment  upon  the  system,  as  well 
as  can  be  modelled,  regardless  of  complexity  or 
computational  loading.  Therefore,  the  dimension  of  the 
truth  model  state  xfc  is  typically  much  higher  than  that 
of  the  models  used  for  controller  design.  For  the  most 
useful  form  of  performance  evaluation  algorithm,  one  desires 
the  ability  to  specify  a  continuous- time  description  of  the 
truth  model,  and  a  discrete-time  description  of  the  digital 
controller  with  a  sample  frequency  that  is  a  variable  design 
parameter.  For  performance  evaluation  purposes,  it  is 
important  to  portray  the  characteristics  of  the  truth  model 
state  xfc  and  the  commanded  controls  u,  as  shown  as 
outputs  in  Fig.  II-2.  It  is  the  truth  model  state, 
depicting  actual  system  characteristics,  and  not  the  state 


truth  model  is  itself  linear,  then  such  statistical  time 
histories  can  be  calculated  explicitly,  without  requiring  a 
Monte  Carlo  analysis  of  many  simulation  runs.  This  is  what 
is  accomplished  in  "PFEVAL" . 

2.6  Software  Tools 

Two  efficient  interactive  computer  software  tools 
have  been  developed  for  the  design  and  performance  analysis 
of  CGT/PI/KF  controllers  (Refs  9  and  21).  Although  one  very 
important  application  is  for  the  design  of  advanced  digital 
flight  controllers,  these  tools  are  in  fact  general  purpose 
and  can  address  a  wide  variety  of  control  design  problems. 

The  first  software  tool,  known  as  "CGTPIF", 
specifically  aids  the  user  in  conducting  the  synthesis  of 
the  components  of  the  CGT/PI/KF  controller  and  some  analysis 
of  characteristics  of  each  of  these  components,  as  discussed 
in  Sections  2. 2-2. 4.  The  second,  "PFEVAL",  conducts  a 
statistical  performance  analysis  of  the  resulting  composite 
controllers,  as  discussed  in  Section  2.5.  Some  of  their 
useful  attributes  for  a  user-friendly  environment  are: 

1)  each  executes  interactively; 

2)  each  utilizes  efficient  array  allocation; 

3)  various  modes  of  entry  are  possible  for  the  dynamics 
models  for  the  design,  command  generator,  and  truth  systems; 

4)  prespecified  design  paths  are  automatically  followed, 
with  user  prompts  at  necessary  decision  points; 

5)  requests  for  inputs  include  informative  prompts; 

6)  copious  program  output  is  provided;  and 


7)  error  checking  is  performed,  and  messages  are  given  as 
appropr  iate. 

Because  of  a  significant  usage  of  matrix  manipulations, 
these  programs  employ  an  efficient  library  of  routines  (Ref 
13).  Aside  from  this  library,  "CGTPIF*  contains  about  2900 
lines  of  source  code  and  "PFEVAL"  has  about  1800.  For  ease 
of  use,  they  are: 

1)  written  in  ANSI  Standard  Fortran  IV; 

2)  highly  portable; 

3)  implemented  on  a  Control  Data  Corp.  CYBER  machine;  and 

4)  segmented  to  achieve  the  necessary  load  size  for 
interactive  use  without  impacting  the  source  code. 

"CGTPIF"  has  three  basic  design  paths:  (1)  design 
of  a  PI  controller  (using  explicit  and/or  implicit  quadratic 
weights),  (2)  design  of  either  an  open  loop  CGT  or  closed 
loop  CGT/PI  controller,  and  (3)  design  of  a  Kalman  filter. 

As  each  of  these  components  is  generated,  its  performance  is 
automatically  evaluated:  either  controller  path  is 
automatically  followed  by  deterministic  analyses  such  as 
pole  placement  computations  and  step  response  plots  (against 
a  system  described  by  either  the  design  model  or  a  truth 
model)  while  the  filter  generation  is  automatically  followed 
by  a  covariance  analysis  of  filter  estimation  accuracy  in  a 
truth  model  environment. 

Initially,  the  user  establishes  the  continuous  time 
design  model  upon  which  to  base  the  controller  and  filter, 
and  also  the  desired  sample  period  (the  software  generates 
all  needed  discretized  models) .  Any  of  the  three  design 


paths  can  then  be  chosen,  typically  in  the  numerical  order 


as  listed  previously.  I£  the  PI  controller  design  is 
pursued  prior  to  the  CGT  design  path,  then  the  subsequent 


CGT  design  will  automatically  be  of  the  CGT/PI  controller. 

If  the  PI  is  not  yet  determined  during  the  current  execution 
of  the  program,  the  designer  may  elect  to  design  either  a 
CGT  or  a  CGT/PI  controller.  The  CGT  design  is  not  pursued 
if  the  open  loop  design  model  is  unstable.  When  any  of 
these  design  paths  are  completed,  the  user  is  given  the 
opportunity  to  loop  on  the  design  path,  to  choose  a 
different  design  path,  or  to  terminate  program  execution. 
Each  traversal  of  a  design  path  yields  a  proposed  component 
for  use  in  Fig.  II-l,  and  all  pertinent  information  is  saved 
in  a  file  for  processing  by  "PFEVAL" . 

"PFEVAL"  specifically  combines  proposed  CGT/PI  and 
Kalman  filter  designs  (as  mentioned  in  Section  2.4.1)  to 
generate  an  entire  composite  controller  as  in  Fig.  II-l,  and 
then  subjects  these  composite  controllers  to  a  covariance 
performance  analysis  of  the  closed  loop  system,  as  shown  in 
Fig.  II-2.  Immediately  after  each  such  CGT/PI/KF  controller 
is  evaluated,  the  corresponding  full  state  feedback  CGT/PI 
is  also  tested  against  the  same  truth  model,  specifically  to 
indicate  the  impact  of  the  filter  on  closed  loop  system 
properties.  By  repeatedly  testing  the  same  controller 
against  varied  truth  models,  the  important  impact  of  the 
filter  on  robustness  (Ref  18:102-114)  can  be  portrayed 
explicitly. 

Together,  the  two  tools  described  provide  a 
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user-friendly  environment  for  efficient  and  systematic 
design  and  performance  evaluation  of  CGT/PI/KF  controllers. 
Applicability  of  the  design  approach  and  software  tools  to 
the  following  objectives  has  been  demonstrated  (Refs  9  and 
21): 

1)  design  of  a  conventional  pitch  rate  controller  for  a 
modern  fighter  aircraft  (AFTI/F-16); 

2)  decoupled  pitch  pointing  control  for  the  same  aircraft; 

3)  effect  of  design  model  order  reduction  on  closed  loop 
system  performance; 

4)  effect  of  parameter  variations  in  the  truth  model  upon 
closed  loop  system  performance,  and  the  impact  of  the  filter 
upon  controller  robustness; 

5)  incorporation  of  implicit  model  following  as  well  as 
explicit  model  following; 

6)  handling  slowly  changing  disturbances  via  PI  controller 
action  versus  direct  rejection  of  modelled  disturbances;  and 

7)  incorporation  of  additional  rolloff  into  the  controller 
to  adaress  the  inadequacy  of  linearized  system  models  at 
higher  frequencies  due  to  neglected  modes  and  other  causes. 


2.7  Summary 

This  chapter  has  introduced  the  CGT/PI/KF  controller 
concept  by  briefly  summarizing  what  is  currently  implemented 
in  the  interactive  computer  programs  "CGTPIF"  and  "PFEVAL" . 
Chapter  III  will  now  present  the  theoretical  development  of 


the  alternate  PI  controller 


3.1 


Introduction 


The  CGT/PI/KF  design  presented  in  Chapter  II  is 
currently  incorporated  into  the  two  software  packages 
previously  discussed.  Since  the  purpose  of  this  thesis 
effort  is  to  design  a  computer  program  that  is  similar  to 
"CGTPIF"  but  bases  the  PI  controller  design  on  the  integral 
of  the  regulation  error,  this  chapter  will  develop  only  the 
equations  pertinent  to  this  effort.  Also,  any  material 
contained  in  the  previous  theses  which  is  needed  or  which 
will  add  continuity  of  thought  to  this  effort  will  be 
repeated  and  incorporated  into  this  development.  This  will 
prevent  the  reader  from  having  to  read  Floyd's  and  Moseley's 
theses  (Refs  9  and  21)  to  understand  this  development  fully. 

3.2  PI  Controller  Based  on  the  Integral 

of  the  Regulation  Error 

The  design  goal  in  employing  a  PI  controller  is  to 
generate  a  feedback  controller  which  will  maintain  the 
deterministic  system  output  at  a  nonzero  commanded  value 
with  zero  mean  steady  state  error,  despite  unmodeled 
constant  disturbances  which  may  also  drive  the  system. 
Invoking  the  "Certainty  Equivalence"  property  (Ref  18) ,  let 
the  deterministic  system  be  described  by  the  time-invariant 
model 


x(ti+1)  “  iH^i)  +  +  4;  3L(tQ)  *  given (III-l) 


Therefore,  it  is  desired  to  generate  a  controller  that  will 
maintain  the  vector  of  controlled  variables  y  (t.) 

*  C  X 

at  a  nonzero  desired  value  despite  unknown 
disturbance  d.  This  is  known  as  achieving  a  "type-one" 
property  (Ref  18) .  One  seeks  a  controller  structure  that 
includes  accepting  a  sensed  error  between  desired  and 
the  achieved  ^.(t^,  and  generating  the  appropriate 
control  to  keep  this  small.  To  keep  the  system  at  a  nonzero 
equilibrium  condition  such  that  the  steady-state  error  is 
zero,  the  controller  fed  by  this  regulation  error  signal 
[^d  -  yc(t^)]  must  be  able  to  deliver  the 

appropriate  nonzero  steady  state  control  when  its  own  input 
is  zero.  This  motivates  the  integral  action  to  form  a 
proportional  plus  integral  or  PI  controller,  accomplished  by 
introducing  an  additional  set  of  dynamic  variables,  with 
defining  difference  equations,  which  are  then  augmented  to 
the  original  states.  For  Linear  Quadratic  Gaussian  design 
of  the  PI  controller,  these  additional  variables  can 
correspond  to  either  (1)  the  "pseudointegral”,  or  summation, 
of  the  (negative)  regulation  error 

a'1!*  *  a(to>  +^.[ic(tj>  ‘ia1 

-  *°‘2c(ti-l)  '  2d1  (III-3) 

or  (2)  the  control  difference  Au(t^) ,  such  that 


where  Au(t^)  can  be  interpreted  as  a  desired  control 
rate  times  the  sample  period 

Autt^  ~  [u(ti)At] 

and  thus  its  alternate  name  of  control  "pseudorate".  The 
second  method  was  the  method  developed  by  Floyd  in  his 
thesis  and  currently  implemented  in  the  program  "CGTPIF", 
and  thus  will  not  be  discussed  further.  The  method  to  be 
developed  in  this  thesis  is  method  1,  the  "pseudointegral" 
of  the  regulation  error. 

The  PI  controller  may  be  formulated  for  implemen¬ 
tation  in  either  of  two  forms,  the  "position  form"  or  the 
■incremental  form".  The  position  form  represents  the 
current  input  in  its  entirety  and  does  so  in  terms  of  the 
total  values  of  the  feedback  variables.  In  the  incremental 
form  only  the  change  in  control  input  from  its  previous 
value  is  computed,  and  it  is  in  terms  of  changes  in  the 
values  of  the  feedback  variables  since  the  preceding  sample 
period.  The  incremental  form  for  the  controller  has  certain 
advantages  over  the  position  form,  such  as  less  concern 
about  proper  initialization  of  augmented  states,  and  is  the 
method  to  be  used  for  final  implementation  (Ref  18). 

The  optimal  PI  controller  is  first  developed  from  a 
discrete-time  problem  formulation.  Subsequently,  the 
technique  for  translating  a  continuous- time  quadratic  cost 


formulation,  which  is  the  formulation  with  which  most 
designers  will  work,  to  the  appropriate  discrete-time  cost 
function  is  demonstrated. 


3.2.1  PI  Mathematical  Development 

Following  the  development  of  Ref  (18) ,  define  a 
"pseudointegral"  state  £(t^)  as  in  Equation  (III-3) 
where 

[jKc(ti)  “  Zd]  =  +  DyVL(t.)  “  (III— 4 ) 

is  the  (negative)  regulation  error  at  time  t^.  The 
system  is  assumed  to  be  in  equilibrium  before  tQ>  so 
<^(t0)  is  equal  to  the  equilibrium  value  attained  up  to 
that  time,  3old  •  of  value  to  be  specified  (which  will 
be  done  later  at  the  same  time  ^  is  established). 

Thus,  this  state  satisfies  Equation  (III-3).  The  augmented 
system  description  then  becomes  (after  shifting  time 
arguments  on  cj,  combining  Equation  (I I I— 2 )  and  (III-3),  and 
setting  £*0.  in  Equation  (Ill-l),  since  d  is  not  to  be 
modelled  in  the  controller  generation) 
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(III-5 ) 


for  ti*to* 

To  satisfy  the  design  goal  in  employing  the  PI 
controller,  that  of  maintaining  ^c(t^)  at  the 


desired  setpoint  yd,  an  equilibrium  solution  must  be 
found  to  yield  £(t^)*£0  for  all  t^,  such  that 
^c(t^)*^<j.  The  nominal  control  to  hold 
the  system  at  that  equilibrium  point  is  found  as  the 
solution  to 
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(III-7) 


or,  rearranging. 
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If  we  assume  that  the  composite  matrix  in  Equation  (III-8) 

is  square  and  invertible,  then  for  any  given  ^d, 

and  u^  can  be  found.  If  we  let 
so 


then 


If  we 

let 

1 

rtr, , 

tr,  „ 

-li 

-12 

<r_ . 

ir  „ 

L“21 

-22 

[VI  '  pi-l)  Sal'1  ' 

kJ  L £  syJ  L 

*  -11  -12  a 

.-21  -22.  _^d_ 


(11-18) 


(III-9a) 


(III-9b) 
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(III-10a) 


(III-10b) 

If  the  composite  matrix  in  Equation  (III-8)  is  not  square,  a 
solution  can  be  found  using  the  left  or  right  inverses  (Ref 
18:124),  but  this  will  not  be  pursued  here. 

Having  found  2^  and  Uq,  perturbation 
variables  can  be  defined  as 


/X(ti)  »  2t(t ±)  -  a  i(ti)  -  £12Xd  (III-lla) 

-  U.C tt)  -  Jl0  ■  U.( t ±)  -  £22yd  (IH-llb) 

*Zc(ti>  *  2c(ti}  -  U  (III-llc) 

JgUj)  -  (111-lld) 

where  ^  is  the  new  "pseudointegral”  state  steady  state 
value,  yet  to  be  determined. 

In  terras  of  the  perturbation  variables,  the 
augmented  system  perturbation  model  becomes  (from  Equation 
(III-5) ) 


"•r*(ti+i>"|  *  [i  owvi  + 

[£  [Dy. 


For  the  optimal  regulator  the  quadratic  cost  criterion  to  be 
minimized  is 
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where  X11  weights  state  deviation  from  the  nominal 
j£0»  &22  we^9^ts  deviations  from  the  nominal 


"pseudo integral"  state  q^  and  £  weights  control 


deviations  from  the  nominal  The  weights  X^. 

apply  to  the  deviations  at  terminal  time,  and  for  an 
infinite  time  duration  steady  state  controller  problem 
(i.e.,  N*»oo)  ,  these  weights  will  not  be  used. 

By  letting  N-»e»  in  Equation  (III-18) ,  and  solving 
for  the  steady-state  control  law,  it  was  shown  (Ref  18:1-60) 
that  the  solution  is  of  the  form 


11  (ti) 
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cl 
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Sc2  1 


-  S^VjLtti)  -  Sc2*^(ti) 


(III-14a) 

(III-14b) 


Substituting  Equations  (III-lla) ,  (III-llb) ,  and  (Ill-lid) 
into  Equation  (m-14b)  yields 


tu  (tA)  -  u0i  -  -  scl  uctj)  -  s0i  -  Sc2  ia(ti)  - 

(III-15) 


or  after  multiplying  and  rearranging  terms 
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V*  <  **  *,*  *_*  *  >  *  •  *  •  *  «'»*  ■*  •  •«*•*»  *.'t'  ji  hV  ,*«  -S  ^ . 


(Ill— 16) 


£*(ti}  =  “  — ci *~ ( fc i }  -  sc2*a(ti) 

+  l*o  +  $cl\  +  -c2*3o^ 


with  determined  as  in  Equation  (III-3). 

*  * 

Scl  and  Gc2  are  found  by  considering  the 

* 

general  form  for  G_  in  Equation  (III-14a)  (Ref 

”  C 

18:73) 


G_*  =  (U  +  B,TK  B.]'1[B,TK  *  +  ST] 
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(III— 17) 


where  K  satisfies  the  backward  Riccati  equation 
— c 


& 


W  -  x  +  -  iadTsc<tul>i  +  sTiTsc* 


(III-18a) 


solved  backwards  from  the  terminal  condition 


-c(tn+l) 


(III-18b) 


to  its  steady  state  value,  or,  equivalently,  solving  the 
(algebraic)  steady  state  version  of  Equation  (III-18a)  for 
the  constant  Kc  *  Kc(t^)  *  Kc(t.^).  ** 

we  take  our  augmented  system  descriptions,  Equations  (III-5) 
and  (III-13) ,  and  partition  them  so  that  each  segment 
matches  an  entry  in  the  general  solution  we  have 
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Multiplying  this  out  yields 


■Scl*  O  -  (S  *  BdT£cllBd  +  By\12Bd 

+  fid\l2ay  +  tty\22Byr1UBd\11i 
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ISd\l2  +SyT£c22  +  £2T.)  (III-20) 


Doing  the  same  thing  for  K.U.)  yields 
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and  multiplying  this  out  yields 


£oll(ti>  -  Su  +  *TSclll  +  STKci2TS  +  lTSci2S 
*  ST£o22C  -  !Bd\ul  +  ByV/l 

+  SdTScl2£  +  SyTSc22£  +  a1TlScl*  UH-22.) 


III-9 


w  mm 


2c22(ti>  ■  222  +  2C22  -  tSdTScl2  +  By\i2 

+  S2T]Gc2*  (III-22b) 

Sc12(ti>  '  2l2  +  ±TSc12  +  £T2c22  -  ‘BdXlli 
*  C/Sc^i  ♦  BdT2cl2^  +  Dy\22S. 

+  £1T1Sc2*  (111-220 


(all  K's  on  the  tight  ate  at  time  ti+l) 

Now  comes  the  question  of  appropriately  choosing 

so  as  to  yield  the  best  possible  transient 

performance  from  Equation  (III-16).  We  seek  the  equilibrium 

value  q  that  results  in  the  lowest  total  cost  to 
•20 

complete  the  process.  It  has  been  shown  that  this  value  of 
qQ  is  found  by  minimizing  (Ref  18:136-137) 


Jmin  »  *WiTi tQ>  /aT(t0)iftcll 


Pci  2 


^c22jL^(to). 


(Ill— 23) 


with  respect  to  ): 


(i  »  ^Jmin  *  -c22^fc0^  +  -c!2  ^-^o* 
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(III-24 ) 


Solving  for  /g(t  )  yields 


'i<*o>  *  Sold  ’  So  *  ‘Sc22’lscl2Tliold  •*C12*dI 
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or 
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(III-26a) 

(III-26b) 


Substituting  Equations  (III-26b) ,  (III-10a) ,  and  (IXI-lOb) 
into  Equation  (III-16)  yields  the  final  control  law  in 


position  form 


u  (t , ) 


where 


a«W  * 


-scl  i(tt)  -  Sc2  l(tj)  +  SZdltj)  (III-27a) 

q(ti)  +  tj:o  (tt)  -  (tt)  1 

i(t.)  +  [£x(t.)  +  DyUtt.)  -  yd(t.)] 


(III-27b) 


-  -  iscl*  -  sc2*Kc22'1£cl2Tiir12  *  — 22 


a'V  •  3oia 


(III-28b) 


The  position  form  control  law  as  given  by  Equation  (III-27) 

is  diagrammed  in  Fig.  III-l.  The  structure  of  this 

controller  is  seen  to  be  composed  of  (1)  full  state  feedback 
* 

through  ,  (2)  command  feedforward  through  E, 

and  (3)  "pseudointegration"  of  the  regulation  error  in  the 

forward  path. 

By  writing  Equation  (III-27a)  for  both  t^  and 
t^_^,  explicitly  subtracting,  rearranging  and 
incorporating  Equation  (III-3),  the  incremental  form  of  this 


III-ll 


PI  law  is  obtained  as 


V„ 

V  / 


u*(t.) 


u  ( t x )  -  Gcl  Ixttj)  ~  x.( t i—1 )  ] 
+  *  id(tt-in 


(III-29) 


There  is  no  explicit  "pseudointegral*  state  in  this  form,  so 

we  do  not  have  to  be  concerned  about  proper  initialization 

of  augmented  states  as  we  do  in  position  forms  (Ref  18:139, 

234-238).  This  is  one  reason  why  incremental  forms  are 

preferred  (also  see  Ref  18:223-260).  It  has  been  shown  that 

either  form  has  the  desired  type-1  property  if 
* 

det{fic2  Hfi#  and  that  ( t , )  converges  to 

yd  in  the  limit  as  t-*»  ,  despite  the  effect  of 
unmodeled  d  (Ref  18:139).  If  we  compare  Equation  (III-29) 
with  Equation  (11-15)  we  can  see  the  similarities  between 
the  two  PI  controller  developments.  The  similarities  are 
pointed  out  in  Ref  (18:148-150)  and  summarized  in  the 
following  discussion. 

The  two  PI  controllers  can  be  interrelated  by  the 
generic  form  of  the  PI  controller  which  is 


11  Ct±)  *  +  KpI^d(ti)  -  Zc(ti)]  +  M(ti} 

(III-30a) 

f(ti+l>  -  f(ti)  +  lXd(ti)  -  Zc(t.)l  (III-30b) 


.  A- 


where  the  state  feedback  gain  G  and  regulation  error 
proportional  gain  Kp  and  integral  gain  Ki  are  given 
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for  the  PI  controller  based  on  the  integral  of  the 
regulation  error,  and  by 


U  -  52V"1(-x 
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(III-32a) 

(III-32b) 

(III-32C) 


for  the  PI  controller  based  on  control  differences.  Note 
that  the  proportional  and  integral  gains  are  distinct  in  the 
PI  controller  based  on  the  integral  of  the  regulation  error, 
whereas,  they  are  the  same  in  the  PI  controller  based  on 
control  differences.  This  difference  should  allow  the  PI 
controller  based  on  the  integral  of  the  regulation  error  to 
compensate  better  for  applications  in  which  the  system  is  in 
fact  nonlinear  and  linear  techniques  are  being  used  to 
generate  perturbation  controls,  i.e.,  for  essentially  all 
real  applications  of  this  synthesis  technique.  This  should 
provide  better  compensation  for  an  important  phenomenon 
called  windup  (Ref  18). 


3.2.2  Converting  from  Continuous  Time  Cost 


Although  the  controller  design  determines  a 
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discrete-time  control  law,  the  design  itself  proceeds  from 
continuous- time  specifications.  The  system  to  be  controlled 
is  generally  a  continuous-time  process  and  so  it  is 
appropriately  defined  by  a  continuous- time  model. 

Since  the  system  to  be  controlled  is  a  continuous¬ 
time  system,  and  since  its  behavior  is  important  at  all  time 
and  not  merely  at  the  controller  sample  times,  the  cost 
function  appropriate  to  the  controller  design  is 


(plus  a  terminal  quadratic  involving  X,£  which  is  not 
used  for  an  infinite  time  steady  state  controller  problem, 
i.e.  for  tN+1 — )  and  where 

x  *  |7x- 

/q 

u  *  /u 

Sc  *  ^cll  *cl2 
_*cl2  ^c22 

Furthermore,  since  the  design  objective  is  to  drive  the 
system  so  that  its  output  tracks  the  desired  output,  it  is 
appropriate  that  the  quadratic  weighting  matrices  specified 
should  apply  to  the  system  outputs.  Equation  (II 1—2 )  but  on 
a  continuous- time  basis,  and  inputs,  u.  Thus,  defining  the 
weights  on  output  deviations  as  Y,  on  input  magnitudes  as 


(III-34a) 

(III-34b) 

(III-34C) 


Uy,  and  on  the  "pseudointegral"  state  as  Ug,  the 
components  of  the  3£c  matrix  are  obtained  as  (Refs  9  and 


-ell 


(III-35a) 

(III-35b) 

(III-35C) 


u  becomes 
c 


U  +  D  YD 
— y  — y  *“y 


(III-36) 


and  S  becomes 
“c 


S  »  I cyd 


(III-37) 


where  C  and  are  as  defined  in  Equation  (III-2)  and  Y, 

Uy  and  Ug  are  positive  seraidef initer  positive 
definite  and  positive  definite,  respectively. 

In  order  to  use  the  continuous-time  cost  function  of 
Equation  (III-33)  for  solution  of  the  discrete-time  optimal 
controller,  it  is  necessary  to  obtain  the  corresponding 
discrete-time  cost  function.  Begin  by  conceptually  dividing 
the  control  interval  t  to  t^+1  into  (N+l)  control 
intervals  of  duration  equal  to  the  intended  controller 
sample  period  T.  The  cost  can  then  be  expressed  as 
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J 


-  > 


ur 

i  *0  •'*' 


itsT(t)xcx(t)  +  u.T<t)ncu.(t) 
+  2iT(t)acii(t)]dt) 


(III-38) 


where  n(t)  is  assumed  constant  over  a  sampling  period  of  T 
seconds  and  &(t)  satisfies 


x(t)  *  ij  (t-t.)  x(ti)  +  S.J  (t-ti)  u.(t.)  (III-39) 

where  for  any  argument  X 


(III-40a) 

with 

*(T)  *  exp{&i:}  (IIX-40b) 


1/  a 


f  (r) 
c 


where  A  defines  the  homogeneous  system  dynamics  in 


x  =  Ax  +  Bu  +  Gw 


(III-40C) 


Also, 


i,  (f) 


ad  (r) 

.  By  J 


(III-41a) 


with 
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iv 


where  li  is  as  given  in  Equation  (III-40c) .  From  Equation 


(III-12),  i/* 

and  g^-a  %^ti+i”ti^  are  9iven  by 

(III-42a) 

(IXI-42b) 


The  discrete  time  cost  function  then  becomes 


N 

J  T  lxTCti)%ilti)  +  uT(ti)I2J.y.(ti) 

ito  rn 

+  2xi(ti)S/u(ti)]  (III-43a) 

where 


h 

« 

[i^T(t)xc^  (r)]dr 

(III-43b) 

2/ 

mf*  T 

ia/T(tr)icslf  (t>  +  uc  +  a/T(r)ac 

+sc\  (t)  1  d  tr 

(III-43c) 

2/ 

rti+v 

iifT(ir)scBf  (r)  +  |fT(r)ac]dr 

(III-43d) 

The  integrals  in  Equations  (III-43b,c,d)  can  be  approximated 
in  a  two-step  computation.  First,  ^  and  Jfy-  are  treated  as 
constants  over  the  sample  interval  with  value  set  to  their 
respective  averaged  values  at  the  beginning  and  end  of  the 


intervals 


ii  “  lLf( 0)  +  i^tti+^i)!  *  ill  +  (III-44a) 

fj  -  [Bj(O)  +  B;(ti+1-t.)]  -  ilO  +  Bj]  (III-44b) 

(Where  the  overbar  mean  approximation) .  with  these 
approximations,  each  of  the  integrands  is  constant  over  the 
integration  time  T,  so  the  integrals  can  be  obtained  as 


I;*  T[|Jx|j] 

V  Tii/xi,  +  ac  ♦  |fTac  +  sc%  i 
I;*  TllJxBj  +  ljscl 


(III-45a) 

(III-45b) 

(III-45C) 


where  T  "  (ti+l“ti)  is  the  sample  period.  This 
provides  a  better  approximate  evaluation  than  simple  Euler 
integration  provides.  Now,  expressing  this  last  cost 
function  in  matrix  format  becomes 


■£  i 


k(ti)]T  i^l  [  x(t.; 

uU.jJ  [l)fT  §;JL^(ti 


(II 1—4  6 ) 


Note  that  the  cross  weighting  matrix  ^  has  been  introduced 
into  the  cost  function  by  the  discretization  process  and 
will  generally  be  nonzero  even  if  s  in  Equation 
(III-33)  were  zero.  This  cost  function  is  seen  to  be  in  the 
standard  form  used  previously  and  all  development  can 
proceed  as  if  the  problem  were  a  discrete  problem  and  not  a 
continuous  one. 
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Now,  in  order  to  obtain  an  equivalent  discrete-time 
cost  function  with  no  cross  weighting  (to  allow  use  of 
standard  Riccati  equation  solvers  as  in  (Ref  12)  that  assume 
such  a  form) ,  define  a  new  system  (Ref  15) 

i(ti+l)  *Ij  *  3t  ( t  ± )  +IJu.'(ti)  (III-47a) 

for  which 

1/  *  If  -  &fSf~1SfT  (III-47b) 

and 

u'(ti)  *  u(ti)  +  (III-47c) 

and  for  which  the  corresponding  cost  function  to  be 
minimized  is 


J' 


N 

\  IiT(ti)IJ,x(t.)  +  u,T(ti)U('u'  (t.)] 

**°  (III-48a) 


with 


lj'  -  Zj  -  Sf5j”1IfT  (III-48b) 

If  the  system  of  Equation  (HI-47a)  is  either  controllable 
or  stabilizable,  letting  N— leads  to  a  steady  state 
solution  of  the  discrete  Riccati  equation  represented  as 
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$  j& 


(Ref  12) 


sR'  *  *,T«»V  +  is' 

-  KR'I[,T[tTJ  +  5jTSr’5(  l*1B<TKR'|(f  '  (II 1—4 9 ) 


and  the  optimal  feedback  control  is 


u* ' (t.)  *  -G  ** x(t,) 


(III-50) 


where 


sc*'  -  tat  *  *TWV*«V 


(III-51) 


The  corresponding  optimal  feedback  gain  matrix  for  the 
original  state  system  is 


*  *  — I  _  m 

sc  ”  s c  •  +  n,  s,T 


(III-52) 


Remembering  from  Equation  (III-19)  that 


So  "  'Scl  Sc2  > 


(III-53) 


the  calculation  beginning  with  a  continuous* time  cost 

* 

description  will  produce  the  correct  2  .  The  only 

question  that  might  arise  is  whether  the  substitution  of 

Kr'  for  ^  is  a  valid  substitution.  (See  Appendix  A 

for  derivation  showing  that  &R’  *  &c) •  The 
* 

g  thus  determined  determines  the  appropriate  gams 
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to  use  in  Equation  (III-29)  for  the  incremental  PI  control 
law. 


3.3 


A  natural  extension  of  the  controllers  developed  in 


the  previous  sections  is  provided  by  a  Command  Generator 
Tracker  (CGT)  in  which  we  require  a  system  to  respond  to 
command  inputs/  while  rejecting  disturbances,  so  that  the 
states  of  the  system  maintain  desired  trajectories  in  real 
time.  In  an  open  loop  conceptualization,  the  problem  is  to 
find  the  appropriate  feedforward  gains  from  the  states  of 
both  the  command  generator  and  a  disturbance  linear  model 
(and  command  generator  inputs) ,  to  the  system  control 


inputs,  that  will  yield  command  generator  tracking.  If  the 
original  system  is  unstable  or  just  marginally  stable,  or  if 
unmodeled  disturbances  and  uncertainties  affect  the  system, 
we  are  motivated  to  add  the  PI  feedback  as  previously 
developed  to  the  system. 

The  development  presented  in  this  section  will  start 
with  the  open  loop  format,  developing  the  appropriate  gains, 
and  then  closing  the  loop  by  adding  the  PI  controller  and 
utilizing  the  open  loop  gains  to  develop  the  complete  CGT/PI 
controller.  There  are  four  formulations  for  this  CGT/PI 
controller.  Two  are  mathematically  derived  and  two  are 
ad-hoc.  These  four  developments  will  be  presented  (all  four 
CGT/PI  controller  formulations  will  be  implemented  in  code 
(see  Appendix  C) ,  and  a  comparison  made  between  them  (see 
Chapter  V) ) . 
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3.3.1  .  Open  Loop  Command  Generator  Tracker 

Consider  a  system  described  by  the  linear  time 
invariant  model 


5<ti+i)  -  tiCt^  +  ^utt.)  +  E^tt.)  +  wd(t.) 


(III-54a) 


^c(tA)  *  +  ByJl(t.)  +  EyaaCti)  (III-54b) 


In  which  rjd  is  a  disturbance  modeled  by 


“d(ti+l>  *  Md(ti>  +  fldn«dn(ti> 


(III-55) 


and  £dn  a  zero-mean  white  Gaussian  noise  of  covariance 
2dn  that  is  independent  of  w^.  The  controlled 
system  modeled  by  Equation  (III-54)  is  to  duplicate ,  as 
closely  as  possible,  the  output  of  a  command  generator  model 


Wi*  ’  +  SdnA. 


(III-56a) 

(III-56b) 


Mathematically,  the  objective  of  the  CGT  is  to  force  the 


error 


S(ti>  ■ 

-  tQ  By  ly]  pL( ' 

u(ti> 

Pd(ti}. 


-  Ifi.  B.lft.Ui)' 


(III-57) 
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to  zero.  When  this  command  error  is  zero,  the  controlled 
system  states  and  controls  are  tracking  the  ideal  system 
trajectory  (satisfying  the  original  system  dynamics  less 
white  noise,  according  to  "Certainty  Equivalence"  ideas) 


Si^i+l*  "  +  BdgI(ti)  +  £xndU.)  (III-58 ) 


Another  requirement  is  that  the  ideal  system  trajectory  be  a 
linear  function  of  the  model  states,  model  controls,  and 
disturbance  states  as  shown  by 


[W|  *  [ill  *12  *13]  p£m(ti> 
.-21  ^22  423.  “m 

.Sd'V 


(III-59) 


where  um < t A for  all  t^. 

The  solution  of  the  CGT  problem  entails  setting  up 
and  solving  the  matrix  equations  that  the  constants  A^ 
through  A23  in  Equation  (III-59)  must  satisfy.  Using 
Equations  (111-54),  (III-58),  (11-18)  and  (III-59)  it  has 
been  shown  that  (Ref  18:153-155) 


An  A12  A13 
A2i  h.22  &23 


■  ttu  s:12l 

.ff21  ff2?J 


«§■-!)>  ^iiSdm>  tAi3(fn-I)- 


(III-60 ) 
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V 


r 


Thus,  in  partitioned  form,  the  equations  to  solve  are 


-11 

“  -llAll(*nfI-)  +  -12^0 

(III-61a) 

^12 

-  ffU AnBdm  + 

(III-61b) 

—13 

"  ^11-13  ^n"-5  “  «lA  ”  — 12— y 

(III-61C) 

—21 

*  2*21— 11  +  ^*22^m 

(III-61d) 

—22 

"  —21— 11— dm  +  ^22— m 

(III-61e) 

—23 

»  £21^13  — 21— x  -^22% 

(III-61f ) 

If  and  can  be  determined  from  Equations 
(III-61a)  and  (III-61c) ,  which  are  of  the  form 

X  -  AXB  +  C  (III-62) 

(for  which  and  algorithm  for  solution  is  available  in  Ref 
(1)),  then  the  other  terms  are  readily  solved  from  these. 
Once  the  values  of  the  A^j  are  found,  then  the  open  loop 
command  generator  tracker  control  law  is  written  from  the 
lower  partition  of  Equation  (III-59)  as 

W  “  ^lW  +  -22^m^ti)  +  A23Bd(ti>  (III-63) 

Xj(t^)  can  also  be  generated  from  Equation  (III-59) 
as 


—I  ( ^ i )  *  — ll-m^fci^  +  ^•12-m^ti)  +  ^H^d^i*  ( 1 1 1—64 ) 


It  is  useful  to  consider  a  PI  closed  loop  law  in 
conjunction  with  command  generator  tracking  because  (1)  it 
forces  the  difference  between  actual  system  output  and 
command  generator  model  output  to  zero  in  steady  state  even 
in  the  face  of  some  modeling  errors,  (2)  it  can  accommodate 
unmodeled  constant  disturbances  as  well  as  reject  the 
modeled  ones,  and  (3)  it  will  also  turn  out  to  include  the 
model  control's  feedforward  contribution  to  the  actual 
system  control  signal.  The  four  formulations  for  the 
closed- loop  CGT/PI  controller  will  now  be  presented.  The 
first  might  be  anticipated  to  be  the  most  practical  and  give 
the  best  performance  since  it  will  assume  the 
■pseudo integral"  states  are  time  varying,  as  they  should  be 
since  the  system  states  are  time  varying.  The  second 
assumes  the  "pseudointegral"  states  go  from  some  initial 
equilibrium  value  to  some  new  equilibrium  value 
instantaneously  with  no  time  varying  transient  period.  This 
would  appear  to  give  a  faster  transient  response  to  the 
system.  The  third  assumes  that  we  have  an  open- loop  CGT  and 
a  feedback  PI  controller  and  connect  them  in  a  feedback 
ad-hoc  fashion.  This  method  would  seem  to  be  logical  but  is 
not  mathematically  derivable  (this  method  also  adds  a  sixth 
gain  to  the  system  which  will  prevent  it  from  being 
compatable  with  the  program  "PPEVAL"  (Ref  21)).  As  a  fourth 
formulation  we  can  neglect  this  sixth  gain,  which  is  a 
direct  feedthrough  gain  on  the  input  ^  . 


This  would 


serve  to  slow  down  the  response  but  would  make  the  system 
compatable  with  the  program  "PFEVAL". 


3. 3. 2.1  CGT/PI  Formulation  1 


Assume  that  the  open  loop  CGT  law  .jit^ 
and  the  associated  ideal  state  trajectory  x.j(t^) 
have  been  evaluated  for  all  t^  as  given  by  Equations 
(III-63)  and  (III-64).  Now  as  done  in  Section  3.2.1,  define 
perturbation  variables  as 


*S<ti> 

*u(t.) 

/yc(ti) 


i<V  -  3l(ti) 

-  atj  (t±) 
u(t.)  -  iiI(ti) 

Xc^i*  "  £l(ti> 


(III-65a) 

(III-65b) 

(III-65C) 

XC<V  ‘  W  (III“65d) 


and  replacing  y^  with  ym(t^)  in  Equations 
(III-3),  (III-4)  and  (III-5)  we  get 


(Vx<tuin  >  |t  oir/iitj)!  + 

L'a'wJ  L£ 


"VI  ^(tj) 


(III-66) 


Now,  using  the  cost  function  of  Equation  (III-13),  the 
optimal  control  solution  using  perturbation  equations  is  as 
in  Equation  (III-14)  and,  returning  to  the  original 
coordinate  system  the  optimal  control  becomes 


a  <tt)  •  VV  +  Sel  ^(tj)  *avi  3l(tt) 
*  -  £c2*i(ti' 


(III-67) 
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As  before,  the  issue  is,  what  is  the  appropriate  value  of 


sf# 


cjj(t^).  If  we  consider  Equations  (III-10a) , 
(II 1—2 5 )  and  (III-26a,b)  we  can  let 


Jlttj)  -  -  Bc22~1Kcl2T*I<ti> 


(III-68) 


and,  substituting  this  into  Equation  (III-67),  we  get  the 
position  form  of  the  optimal  controller 


U  (tj)  *  StjUj)  +  -  Sc2  B,.22  Bc12  lijftj) 

-  Sd'sitj)  -  a^'actj)  (in-69) 


with 


GB 


I^i+l*  ■  i(ti>  + 


UII-70) 


To  get  the  preferred  incremental  form  of  the  complete  CGT/PI 
controller  we  need  to  write  Equation  (m-69)  at  time  t^ 
and  explicitly  subtract  the  two,  substitute  for 

^(tf)  and  Equations  (III-63)  and 

(III-64)  respectively,  rearrange  terras  and  utilize  Equation 
(III— 70 )  to  get 


*  * 

u  (tj)  *  u 

<‘1- 

i> 

Scl 

+ 

it 

sc2 

+ 

l^21 

+ 

V*i- 

+ 

N 

CM 

<1 

+ 

+ 

^—23 

+ 

“niloatti)  - 

“d(ti 

(III-71) 
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where 


-  “  -cl  "  -c2  -c22  1-c12T 


(III-72) 


If  we  incorporate  Equations  (III-2)  and  (III-56b)  into 
Equation  (III-71)  we  get 


u  (t^) 


1 

u 

*<fci- 

1> 

-  Sd'txlti)  - 

-(ti- 

+ 

♦ 

-c2 

“5m  Bml 

-  IQ 

Lrm(t  i-1  j 

+ 

l-21 

+ 

--llltim(ti)  " 

+ 

l&22 

+ 

^12ll»m(ti)  ’ 

+ 

^23 

+ 

iQ^(t^)  “ 

nd(t 

where  L  is  as  in  Equation  (III-72). 

We  have  always  assumed  that 


Ua(ti)  -  um  -  constant  i  »  0,1,2, 
*  “m  1  * 


i.e.,  that  u„  is  constant  from  t  forward.  For 
practical  implementation,  any  time  that  um  changes  will 
cause  i  to  be  set  to  zero  again.  However,  an  inconsistency 
in  the  definition  of  the  ideal  trajectory,  Equations 
(III-58)  and  (III-59),  arises  at  the  time  of  a  step  change 
in  u  .  It  has  been  shown  (Ref  18:161-162)  that  to  avoid 
this  inconsistency,  whenever  j^(t^)  changes,  we  go 
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back  to  time  tj_^  and  restart  all  variables  under  our 
control.  This  simply  results  in  the  command  generator 
model.  Equation  (III-56a)  becoming 


*m(ti>  "  imx-m(ti-l>  +  ^dmW 


(III-74 ) 


Incorporating  this  into  Equation  (III-73)  will  remove  the 
inherent  delay  between  system  input  and  control  output  since 
the  control  is  being  applied  one  sample  period  earlier  than 
before  and  yields  the  final  CGT/PI  control  law  as 


u*(ti-1)  -  Gq1  *  [  x  ( t  i )  -  X.Uj.-l)] 

+  &c2*<I£m  [VWl-  '=  V 

*  '*21  +  B&nl 

+  1*22  +  Ml2Il»m(ti>  -  VW 

+  1*23  +  B&l3Jt!ld(ti)  * 

(III-75) 

where  L  is  as  given  in  Equation  (III-72).  (If  we  compare 
Equation  (III-75)  with  Equation  (11-18)  we  can  see  the 
similarities  between  the  two  CGT/PI  control  laws.  These 
similarities  are  sufficient  enough  to  allow  the  gains 
determined  from  this  development  of  the  CGT/PI  control  law 
based  on  the  integral  of  the  regulation  error  to  fit 
directly  into  the  CGT/PI/KF  evaluation  program  "PFEVAL" 
without  modifying  "PFEVAL"  in  any  way.) 


3. 3. 2. 2  CGT/PI  Focmulation  2 


Begin  by  considering  the  previous  development  up 
through  Equation  (III-67).  As  before,  the  issue  is,  what  is 
the  appropriate  value  of  SLi  ( t ^ ) .  We  could  seek  the 
best  equilibrium  <jIq  and  if  we  combine  Equations 
(III-56a)  and  (III-56b)  for  the  equilibrium  condition 


^mo  “  ^-m^”^m^  ^dm  + 


(III-76) 


If  we  assume  this  condition  also  applies  for  the  transient 
period,  we  can  combine  Equation  (III-68a)  with  Equation 
(III-26a) ,  with  *  xmo  to  get 


(III-77) 


Substituting  this  into  Equation  (III-67),  we  get  the 
position  form  of  the  optimal  controller  as 


u  (t^) 


+  Scl  -I16!*  "  -c2  ^c22  Kc12  -12 

+  WV  "  Sci*S<‘i> 

*  Sc2*a<ti>  (III-78) 


and  Equation  (III-70)  still  applies.  To  get  the  preferred 
incremental  form  of  this  CGT/PI  controller  we  need  to  write 
Equation  (II 1—78 )  at  time  tj^  and  tj_lf  explicitly 
subtract  the  two,  substitute  for  ( t ^ )  and 
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W 


Equations  (III-63)  and  (III-64), 
respectively,  rearrange  terms  and  utilize  Equations  (III-70) 
and  (III-74)  to  get 


u  ( t 


a  (t^)  ■  Sci  Ixttj)  -  at( t i-:L )  ] 

+  Gc2*{tcm  Dn]  rxm(ti_1ri  -  [q  By]  r 

L5Jm(ti)  J  La*(ti-1 

+  l-21  +  -cl  -ll^-m^i*  "  ^m^i-l*1 

+  ^-22  +  -cl  -12"- 1  ^m^i*  “  umtti-l)1 

+  ia23  +  gc1  A13][nd(ti)  -  HaU^)] 


(III-79) 


where 


H  -  +  V  tni-soj 


3. 3. 2. 3  CGT/PI  Formulation  3. 

Begin  by  assuming  that  we  have  the  PI  controller 
given  by  Equation  (III-27)  and  the  open-loop  CGT  given  by 
Equation  (III-63).  If  we  put  Equation  (III-27)  into  terms 
of  perturbation  variables,  replacing  with  ym  we 
have 


!L  (ti>  "  “2cl  /*(*!>  -  Sc2  /sKt^  +  B^m(t.)  (III-81) 


and  utilizing  Equations  (III-65a,b,c)  we  have 
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(III-82 ) 


fc  te* 


u*(t.) 


-  Bjltj)  = 


-ficl  U(ti> 

'Sc2*|a(ti) 
+  £in(tl) 


- 

-  3i (ti) I 


Substituting  in  Equations  (III-63)  and  (III-64),  and 
rearranging  terms  we  have  the  position  form  of  this  optimal 
controller  as 


u  tfci)  3  t&2i  +  acl  ^ll]itm(ti) 

+  tA22  +  Gcl  Ai213im(fci) 

+  [A23  +  Gcl  A13]nd(ti) 

-  Scl*x(ti)  -  £c2*<L<t.)  +  GC2*a-I(ti)  +  ^m(ti} 

(III-83) 


To  get  the  preferred  incremental  form  of  this  CGT/PI 
controller  we  need  to  write  Equation  (III-83)  at  time  t^ 
and  tj,#  explicitly  subtract  the  two,  utilize  Equations 
(III-70)  and  (III-74),  and  let  to  get 


u  (t  i ) 


u  ( ti—1 )  -  Gcl  ti ( t±)  -  x(ti_1)l 

+  sc2*usm  5m]  rvwi-  ic  Dy]  rx(tw 


-m' fci- 
Hm(ti] 


a  (t,  ,) 


+  ^—21  +  -cl  -lllt^mtti)  “  -m^i-l51 

+  ia22  +  gc1  a12i  [^(tj^)  -  a.m  ( 1 L )  1 

+  ^A23  +  G<,1  A13][nd(ti)  -  D<j(ti-i^ 

+  S{tcra  Pra]rxm(ti)  -  xm(ti.1n 
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'  ,  •  j  *  .  *  .  '  .  *  •  *  »  ^ 


3. 3. 2. 4  CGT/PI  Formulation  4. 

Since  the  CGT/PI  controller  given  by  Equation 
(III-84)  has  six  gains  instead  of  the  usual  five  of  the 
other  CGT/PI  controllers,  we  could  consider  neglecting  the 
sixth,  that  given  by  £,  which  is  a  direct  feedthrough 
speedup  mechanism,  and  formulate  a  controller  based  on  this 
simplification.  (Note  this  has  the  same  effect  as 
neglecting  the  N  term  in  Equation  (III-79)).  (This 
formulation  will  allow  this  use  of  the  program  "PFEVAL"  (Ref 
21),  which  requires  only  five  gains  as  inputs.)  The 
resulting  controller  is  given  by 


a  (tt) 


«•  -  Sci  ‘s'V  *  i(ti-i)! 

♦  sc2*ucm  Bmi  fc.Ui.xn  -  ic  v  [ 

[yv  J  [/< 

*  '*21  +  ScAnHs.!*!'  -  *.(tl-l>1 

+  '-22  +  Sd  &121  '^^i1  ■ 

+  [S23  +  Scl 
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Adding  Implicit  Model  Followinc 


In  Chapter  II,  it  was  stated  that  implicit  model 
following  is  achieved  by  including  the  model  in  a 
performance  index  that  weights  the  error  between  system 


output  derivatives  and  the  desired  model  dynamics.  A 
standard  performance  index  is  of  the  form  of  Equation 


(Ill— 86) 


(There  may  or  may  not  be  a  cross  weighting  term  §,) 
where  it  is  assumed  that  the  system  can  be  described  as 


x  »  Ax  +  Bu 


(III-87 ) 


with  output 


(III— 88 ) 


Now,  instead  of  the  index  of  Equation  (III-86),  define  a 
performance  index  which  weights  the  error  between  system 
output  derivatives  and  the  model  dynamics,  where  the  model 


*m  “ 


(III-89) 


and  the  corresponding  performance  index  is 


JI  <  I(*c  "  &m*c)Txi(£c  “  ^mic)  +  ^iUldt  (HI-90) 

where  the  dimension  of  the  output  vector  yc  and  the 
model  state  vector  are  equal.  The  weighting  matrix 
Xj  weights  errors  between  the  output  and  model  dynamics. 
Substituting  Equations  (III-87)  and  (III-88)  into  Equation 
(III-90)  yields 
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1  iC 


J-r  -SI  l  (££x  +  QBu  -  &m£x)  Xx(C&x  +  QBu  -  AmCx) 


+  u  UjU]  dt 


(III-91) 


After  collecting  terms.  Equation  (III-91)  leads  to  a 
performance  index  similar  to  Equation  (III-86)  but  with  a 
cross  weighting  term  relating  deviations  in  x  and 


Jj'  -ij*  [*%*  +  2xT|iu  +  u^iil  dt 


(III-92) 


where 


a 

h 


(CA  -  hmQ)  - 


ij  9  (CA  -  AmC)TXIQB 


A 

-I 


T  T 

Uj  +  BCXjCB 


(III-93a) 

(III-93b) 

(IXI-93C) 


and  Xj  and  Uj  are  symmetric  with 


*  Q. 


iiT  >  a 


(III-94a) 

(III-94b) 


If  we  rewrite  Equation  (III-92)  as 


■•if 

A* 


_  a 


I  T  a 
‘I  -I 


x 

U 


dt 


(III-95) 


and  comparing  this  with  Equation  (III-33) ,  letting  the 
combined  implicit/explicit  cost  function  be 
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>4 

Vi 

c? 


g 


$ 


5 


O 


JIE  ■  V  +  JE 


(JE  *  explicit  cost  function  derived  from  the  continuous 
cost  function  discussed  previously) ,  we  have 


IE 


r-„  *i  T 


✓2 
*f  y. 


x 

(s 


A 

+  -I 


+  ii 


a  +  S] 

A 


u  +  u. 


Yx' 

/u 

dt 
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Therefore,  to  add  implicit  model  following,  all  we  need  do 
is  add  the  appropriate  implicit  weights  to  the  appropriate 
locations  within  the  defining  cost  function.  The  overall 
cost  weighting  matrix  thus  becomes 


i 


~fi 

T  [! 

Si 

fa. 

a 

flq 

a 


V 

Si 

J 

Ju_ 

dt 

(III-98) 


3.5 


Summary 

Chapter  III  has  presented  a  theoretical  development 
of  the  PI  and  CGT/PI  controller  with  the  PI  controller  based 
on  the  integral  of  the  regulation  error.  The  equations 
presented  in  this  chapter  were  implemented  in  code  and 
evaluated.  The  following  chapters  and  appendices  will  look 
at  the  programs  developed  from  these  equations  and  compare 
them. 
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4.1  Introduction 

The  primary  objective  of  this  thesis  effort  is  to 
create  a  computer  program  with  which  to  design  CGT/PI/KF 
controllers  with  the  PI  controller  based  on  the  integral  of 
the  regulation  error.  This  chapter  presents  a  general 
description  of  the  program  which  has  been  developed 
—hereafter  to  be  referred  to  as  CGTPIQ — and  incorporates  a 
discussion  of  those  portions  of  the  program  "CGTPIF"  (Refs  9 
and  21),  upon  which  CGTPIQ  is  based,  needed  to  add 
completeness  of  thought  to  the  discussion.  There  were 
actually  four  programs  developed  to  consider  the  four 
formulations  of  the  CGT/PI  presented  in  Chapter  III.  The 
discussion  in  this  chapter  pertains  to  the  program  developed 
which  implements  CGT/PI  formulation  1  of  Section  3. 3. 2.1. 

The  other  three  programs  are  very  similar  as  only  a  few 
lines  of  code  needed  to  be  changed  to  implement  the  other 
three  CGT/PI  formulations.  (The  required  code  changes  are 
documented  in  Appendix  C.) 

While  the  specific  test  application  for  the  program 
in  the  context  of  this  thesis  has  been  related  to  aircraft 
control  design,  CGTPIQ  is  written  to  be  applicable  to  a  wide 
variety  of  control  design  problems.  It  has  the  following 
attributes: 

1.  CGTPIQ  executes  interactively 


2.  The  program  utilizes  efficient  array  allocation 

a.  Initial  memory  allocation  easily  set 

b.  Dynamic  array  allocation  within  total  memory 
allocated 

3.  Various  modes  of  entry  are  possible  for  the 
dynamics  models 

4.  Design  paths  are  automatically  followed,  with 
user  prompts  at  necessary  decision  points 

5.  Requests  for  input  include  informative  prompts 

6.  Copious  program  output  is  provided 

a.  Output  most  relevant  to  design  decisions  are 
provided  directly  to  the  terminal 

b.  Additional  detailed  output  is  provided  to  a 
separate  output  file 

7.  Information  relevant  to  design  iteration  is 
preserved 

8.  Information  needed  for  evaluation  by  computer 
program  "PFEVAL*  is  preserved  (Ref  21) 

9.  Error  checking  is  performed,  and  messages  given 
as  appropriate 

CGTPIQ  employs  computational  routines  available  in  a 
library  of  matrix  computer  routines  described  in  Ref  (13). 
Exclusive  of  the  library  routines,  the  program  has  a  length 
of  more  than  2900  lines  of  source  code.  The  programming 
language  employed  is  ANSI  Standard  FORTRAN  IV.  Although  the 
resulting  source  code  is  highly  portable,  local  memory 
utilization  limits  for  interactive  execution  may  impose 
constraints.  In  use  on  a  Control  Data  Corporation  CYBER 


machine/  the  necessary  load  size  was  achievable  with  no 
impact  on  the  source  code.  Thus  the  existing  source  code  is 
in  a  pure  form  for  whatever  system.  However,  the  final 
program  size  is  much  greater  than  the  normal  65000  octal 
word  limitation  of  the  CYBER  interactive  system.  Thus,  in 
order  to  achieve  interactive  operation  and  provide 
sufficient  free  memory  for  array  allocation  so  that  problems 
of  large  and  variable  dimensions  can  be  treated,  a  CYBER 
Loader  option  referred  to  as  "Segmentation"  (Ref  7)  must  be 
used.  The  required  segmentation  code  will  be  presented  in 
Appendix  B.  (Even  with  segmentation,  the  interactive 
program  uses  nearly  67000  octal  words.) 

CGTPIQ  was  written  specifically  to  run 
interactively.  Requests  for  input,  while  intentionally 
brief,  tell  the  user  what  is  expected  of  him — what,  how 
many,  and  in  what  units,  as  appropriate.  Output  of 
information,  relevant  to  design  decisions,  to  the  terminal 
is  compact  and  automatically  provided.  Also,  the  user  can 
determine  the  amount  and  category  of  output  to  the  terminal 
in  some  cases,  and  according  to  need. 

An  objective  of  this  thesis  effort  was  for  CGTPIQ  to 
be  similar  to  the  program  "CGTPIF"  by  Floyd,  as  modified  by 
Moseley,  and  every  effort  was  made  for  this  to  be  the  case. 
For  this  reason  the  two  program's  are  almost  identical  in 
operation.  The  differences  are  presented  in  the  appendices. 
Appendix  A  will  give  a  description  of  only  those  routines 
that  had  to  be  changed  in  going  from  "CGTPIF"  to  "CGTPIQ. 
Appendix  B  will  give  a  complete  User's  Guide  to  enable  the 
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user  to  use  this  program  without  having  a  copy  of  the  thesis 


covering  "CGTPIF". 

4.2  Program  Operating  Principles 

and  Organization 

CGTPIQ  has  three  design  paths:  (1)  design  of  a  PI 
controller  (using  explicit  and/or  implicit  quadratic 
weights);  (2)  design  of  either  an  open- loop  CGT  or 
closed- loop  CGT/PI  controller,  and  (3)  design  of  a  Kalman 
filter.  Corresponding  to  the  first  two  design  options  is  a 
controller  evaluation  set  of  routines,  and  corresponding  to 
the  third  design  option  is  a  set  of  routines  for  filter 
evaluation.  The  evaluation  routines  perform  the 
computations  discussed  in  Appendix  D. 

A  general  flowchart  of  CGTPIQ  is  given  in  Figure 
IV— 1 ,  showing  the  main  execution  paths  and  design  entries. 
The  controller  sample  period  is  entered,  the  design  model  is 
established,  and  then  the  desired  design  path  can  be 
followed.  The  elementary  design  path  choice  is  between 
controller  and  filter  designs.  The  CGT  or  CGT/PI,  and  the 
PI  controller  (for  explicit  and/or  implicit  quadratic 
weights)  design  paths  are  then  options  within  the  controller 
design.  If  the  PI  controller  design  is  pursued  prior  to  the 
CGT  design  path,  the  CGT  design  will  automatically  be  of  the 
CGT/PI  controller.  If  the  PI  controller  gains  have  not  been 
determined  during  the  current  execution  of  the  program,  then 
the  designer  may  elect  to  design  either  a  CGT  or  a  CGT/PI 
controller.  However,  the  CGT  controller  design  is  not 


pursued  if  the  open-loop  design  model  is  unstable.  The 
controller  design  path  is  followed  automatically  by  the 
appropriate  controller  evaluation  path.  Similarly,  the 
filter  design  path  leads  automatically  to  the  filter 
evaluation.  When  the  evaluation  is  complete  the  designer  is 
given  the  opportunity  to  loop  on  the  design  path,  choose  a 
different  design  path,  or  terminate  program  execution. 

4.3  Dynamics  Models 

The  system  for  which  a  CGT/PI/KF  controller  is  to  be 
developed  is  assumed  to  be  well  represented  by  a  set  of 
linear,  time  invariant,  stochastic  state  differential 
equations  with  zero-mean  white  Gaussian  noise  driving  the 
system  and/or  disturbance  states,  and  corrupting  the  system 
measurements.  Such  equations  generally  are  derived  as 
linearized  perturbation  equations  for  a  non-linear  system 
about  a  nominal  operating  point. 

Three  system  models  are  employed:  a  "truth  model",  a 
"design  model",  and  a  "command  model".  The  truth  model  is  a 
model  of  the  system  which  is  as  complete  and  accurate  as 
possible  for  the  control  task  under  consideration.  The 
design  model  is  generally  a  simpler  model  and  is  the  basis 
for  the  controller  and  filter  gains  and  provides  the  set  of 
states  to  which  these  gains  are  applied.  While  the  quality 
of  the  resulting  design  is  often  developed  by  initially 
evaluating  their  performance  with  respect  to  the  design 
model,  their  fine  tuning  to  "true"  performance  potential  in 
the  real  world  environment  must  ultimately  be  with  respect 


to  the  system  truth  model.  The  command  model  is  a  model 
representing  the  commands  you  wish  the  system  to  follow  or 
the  desirable  characteristics  you  wish  the  system  to 
emulate.  Each  of  the  three  models  is  defined  initially  as  a 
continuous- time  system,  then  is  discretized  by  the  program 
for  use  within  the  program. 


4.3.1  Design  Model 

The  design  model  is  given  by 

x(t)  *  &S(t)  +  ay{t)  +  Exnd(t)  +  Gw ( t)  (IV-la) 

Sd(t)  *  Anad(t)  +  Sn“d(t)  (IV-lb) 

yc (t)  -  Cx(t)  +  Dyu(t)  +  £ynd(t)  (iv-lc) 

z  (t -  Hxft^  +  Hnnd(t.)  +  y(ti)  (iv-ld) 

and  w,  wd,  and  v  are  independent  zero-mean  noises  with 
statistics 

E{w(t)wT(t+T) }  «  g/(T)  (IV-2a) 

Etwd(t)wdT(t-HT)  }  -  gnJ-(T)  (IV-2b) 

E(2(ti)  vT(tj)  }  =  (IV— 2c) 

In  these  equations,  x,  Qd,  yc,  and  z.  are  the 


system  state,  input,  disturbance  state,  output,  and 
measurement  vectors,  respectively.  The  dimensions  of  the 
model  are 

n  »  number  of  system  states 

r  »  number  of  system  inputs 

p  *  number  of  system  outputs 

m  *  number  of  system  measurements 

d  *  number  of  disturbance  states 

w  ■  number  of  independent  system  noises 


wD*  number  of  independent  disturbance  noises  (IV-3) 

and  the  dimensions  of  the  matrices  of  the  model  are 

A  :  n-by-n 

B  :  n-by-r 

Ex:  n-by-d 

£  :  n-by-w 

£  :  w-by-w 

C  :  p-by-n 

Dys  P-by-r 

Ey:  p-by-d 

H  :  m-by-n 

H :  ra-by-d 

-n 

a  :  m-by-m 

An:  d-by-d 

V  d-by-wD 

Qn:  WD"by”WD  (IV— 4 ) 

A  constraint  to  be  imposed  is  that  the  number  of 
design  system  inputs  and  outputs  be  equal:  r*p.  Also,  the 
number  of  system  states  may  not  be  less  than  the  number  of 
disturbance  states,  due  to  the  computational  setup  used  for 
the  CGT  solution.  The  dimensions  n,  r,  and  p  must  be 
non-zero;  any  of  the  other  dimensions  may  be  zero.  If  m  is 
zero  or  if  w  and  v»D  are  both  zero,  the  Kalman  filter 
design  path  cannot  be  pursued. 

The  design  model  is  discretized  at  a  specific  fixed 
controller/filter  sampling  period  T  as  follows.  The 
disturbance  state  description  is  augmented  to  the  system 
state  model  and  discretized  to  form 


*a(ti+l>  '  Ma(ti'  +  +  *ad(ti>  (IV-51 


where  "a"  means  augmented,  and  assuming  the  u  is  constant 
over  a  sample  period, 


*  *  e^aT 

—a  ^ _ 


(DELg  df 


(IV-6a) 

(IV-6b) 


where 


is  zero-mean  white  Gaussian  discrete-time 


noise  of  discrete-time  noise  covariance 


.a<T>Sa2aSaTiaT<ttd1: 


(IV-6c) 


The  matrices  of  Equations  (IV-6a,b,c)  may  then  be 
partitioned  to  the  original  component  dimensions.  Invoking 
the  "Certainty  Equivalence"  property  previously  presented, 
the  discrete-time  models  to  be  used  for  the  deterministic 
controller  design  are  the  system  state  transition 
(propagation)  equation,  disturbance  state  equation,  and 
output  equation  defined  by 


i<*W  -  +  Baiiiti)  +  6xaQd(ti> 

Bd^i+l1  "  *nnd(tl' 

+  EyOaftj) 


(IV-7a) 

(IV-7b) 

(IV-7c) 


with  C,  0^,  and  E^  as  in  Equation  (IV-lc) . 

Henceforth,  all  equations  relating  to  the  controller  design 


are  considered  deterministic. 


4.3.2  Truth  Model 

The  truth  model  is  specified  by 

xfc(t)  =  Afcxfc(t)  +  B^U)  +  gtwt(t)  (IV-8a) 

lt(t)  *  +  Jtt(ti)  (IV-8b) 

x' (t)  *  -DT^t ( t)  (IV-8c) 

nd’ (t)  -  INT5t(t)  (IV-8d) 

and  wfc  and  vfc  are  assumed  to  be  independent 
zero-mean  noises  with 

E{wt(t)wtT(t+T)  }  =*  Qt/(f)  (IV-9a) 

E{Yt(t.)ytT(tj)  }  *  Rt/ij  (IV-9b) 


where  Equations  (IV-8c)  and  (IV-8d)  relate  the  system  and 
disturbance  states  of  the  design  model  to  the  system  states 
of  the  truth  model.  Note  that  gfc  and  are  both 
assumed  to  be  diagonal  matrices.  In  these  equations, 
xfc,  ufc,  and  z,fc  are  the  truth  model  system  state, 
input,  and  measurement  vectors,  respectively.  The  vectors 
x'  and  2^'  are  as  defined  for  the  design  model. 

The  dimensions  of  the  truth  model  are 

nT  *  "number  of  system  states" 

rT  *  "number  of  system  inputs" 

mT  •  "number  of  system  measurements" 

wT  *  "number  of  independent  noises  driving  system 

dynamics"  (IV-10) 

and  the  dimensions  of  the  matrices  of  the  model  are 
"T-by-nT 
at*  nT-by-rT 


IV-10 


nT-by-wT 


at:  wT-by-wT 

Ht!  raT-by-nT 
n^-by-n^ 

IDT:  n-by-nT 

Int!  d‘bi'-nT  (IV-11) 

Dimensional  compatibility  for  computations  requires 
that  the  numbers  of  inputs  and  of  measurements  for  the  truth 
and  design  model  be  the  same:  rT=r  and  mT*m.  If  the 
number  of  driving  noises  (wT)  is  zero,  evaluation  of  a 
Kalman  filter  design  is  not  pursued  (since  a  covariance 
analysis  with  no  truth  model  driving  noise  would  not  be  very 
informative) . 

The  truth  model  is  discretized  for  a  specific 
controller/filter  sampling  period  T,  yielding 
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4.3.3 


Command  Mode 1 


The  command  model  is  given  by 

Sm(t)  '  5-A(t>  +  W*>  (IV-14a) 

zjt)  -  c.s.ct)  +  n.u.tfc)  (iv-i4b) 

In  these  equations,  xm,  um,  and  are  the 
command  model  state,  input,  and  output  vectors, 
respectively. 

The  dimensions  of  the  command  model  are 

nM  *  "number  of  model  states" 

M 

rM  “  "number  of  model  inputs" 
n 

p  ■  "number  of  model  outputs"  (IV-15) 

M 

and  the  dimensions  of  the  matrices  are 

V  nM'by-nM 

V  Vb*-'M 
=m!  P«-bi"nM 

V  PM-by-rM  (IV-16) 

Since  it  is  desired  to  cause  the  system  outputs  to 
follow  those  of  the  command  model,  it  is  necessary  that  the 
number  of  outputs  of  the  command  and  design  models  be  equal: 
p»p.  Also,  the  number  of  system  states  of  the  command 
model  (n„)  cannot  be  greater  that  the  number  of  system 
states  of  the  design  model  (n) .  This  constraint  is  due  to 
the  setup  for  computation  of  the  CGT  solution. 

The  discretized  command  model  becomes 


2»(tl+l>  ■  tmW  + 

Stm'h1  ’  WV  +  WV 


(IV-17) 


(IV-18) 


where,  for  u  constant  over  a  sample  period 
—in 

(IV-19a) 
(IV-19b) 

and  C  and  D  are  as  before  in  Equation  (IV-14b) . 

**m  -m 

(Note:  the  command  model  for  explicit  and  implicit  model 
following  need  not  be  the  same,  though  they  may  be.) 


4.3.4  Overall  Model  Dimensions 

Problems  of  the  following  dimension  can  be 
accommodated  by  CGTPIQ 
n  -  15 

n+d  *  15 

r  *  5 

p  <  5 

m  *  15 

w  *  15 


than  and  some  less  than  these  specific  dimensions,  will  also 
be  accommodated  due  to  the  method  by  which  arrays  are 
allocated  and  stored.  If  the  user  has  a  problem  that  does 
not  fit  these  size  restraints,  he  should  try  the  problem  to 
see  if  it  will  work.  Messages  will  be  printed  if  he  has 
exceeded  total  allocation,  and  in  that  case,  the  basic 
program  code  will  have  to  be  altered  to  proceed. 

4.4  Entry  of  Dynamics  Models 

Any  of  the  three  dynamics  models  described  above  may 
be  established  in  any  of  three  ways:  (1)  the  dimensions  and 
matrix  elements  may  be  entered  directly  from  the  terminal; 

(2)  the  dimensions  and  matrix  elements  may  be  entered  from  a 
"DATA”  file;  or  (3)  the  dimensions  and  matrix  elements  may 
be  established  by  user  provided  subroutines.  When  entered 
from  the  terminal  directly  or  set  by  subroutines,  only 
non-zero  elements  of  the  various  matrices  need  be  given.  In 
many  cases,  this  substantially  simplifies  establishing  the 
matrices  and  reduces  the  probability  of  erroneous  entries. 
Subsequent  design  runs  for  the  same  problem  can  then  simply 
read  the  models  from  the  "DATA"  file  previously  created. 

Before  attempting  to  use  the  program  the  following 
should  be  noted: 

1.  The  design  model  may  be  entered  only  once  during 
a  single  program  execution.  Thus,  in  order  to  modify  the 
design  model,  it  is  necessary  to  re-execute  the  program. 

2.  The  truth  and  command  models  may  be  redefined  as 
often  as  desired  during  a  single  program  execution. 


3.  The  SAVE  and  DATA  files  should  be  used  to 


preserve  the  design,  truth,  and  command  models  between 
distinct  program  executions.  SAVE  is  a  write  only  file  and 
DATA  is  a  read  only  file  so  information  must  be  transferred 
from  the  SAVE  to  the  DATA  file  between  program  executions 
(see  Appendix  B) . 

4.  Models  may  be  read  from  the  DATA  file  repeatedly 
during  program  execution. 

5.  Changes  in  model  dimensions  require  that  all 
relevant  defining  matrices  be  reentered  anew.  Changes  in 
dimension  for  a  single  model  may  require  changes  in 
dimensions  for  another  due  to  the  interrelationship  of  the 
different  models.  Also  the  matrices  2DT  and  TNT  may 

need  to  be  changed. 

4 . 5  Using  the  CGTPIQ  Design  Program 

A  few  simple  considerations  of  the  operation  of  the 
design  program  particularly  impact  its  ease  of  application 
to  specific  design  problems.  These  and  other  more  specific 
considerations  are  discussed  fully  in  the  "User's  Guide"  of 
Appendix  B,  and  the  reader  is  encouraged  to  refer  to  this 
manual  before  attempting  to  use  the  program.  The  following 
should  be  noted  in  addition  to  that  discussed  in  Section  4.4 
above: 

1.  Open-loop  CGT  designs  can  only  be  pursued  in  a 
given  execution  of  the  program  if  a  PI  controller  design  has 
not  previously  been  accomplished  and  PI  gains  have  not  been 
read  from  the  DATA  file. 


2.  Any  of  the  three  design  paths  (PI  controller, 
CGT  controller,  or  Kalman  filter)  may  be  executed  in  any 


order  and  as  often  as  desired  during  a  single  program 
execution.  Results  from  each  design  path  are  preserved 
independently  throughout  execution. 

3.  In  addition  to  the  output  available  at  the 
user's  terminal,  the  same  and  much  additional  information  is 
output  to  the  file  named  'LIST'.  Following  execution,  this 
LIST  file  may  be  routed  to  a  line  printer  for  listing. 

4.  Plots  of  system  time-response  at  the  user 
terminal  provide  a  very  useful  evaluation  tool. 

5.  Regardless  of  the  plot  duration  specified,  the 
plot  will  include  50  time  samples.  These  samples  are 
uniformly  distributed  in  time  over  the  entire  duration 
specified  or  automatically  adjusted  by  the  program. 

6.  In  order  to  bypass  the  time-response  evaluation 
(no  plots  to  the  terminal  or  to  the  LIST  file)  one  need  only 
specify  that  no  plots  are  wished.  For  the  CGT  evaluation, 
specifying  a  zero  index  for  the  command  input  also  bypasses 
the  time-response  evaluation. 

7.  The  user  must  have  a  basic  idea  of  how  to  design 
CGT/PI/KF  controllers  using  this  program  before  beginning 
execution  so  that  questions  asked  of  the  user  by  the  program 


The  plots  of  system  response  produced  by  CGTPIQ  are 
of  the  "line  printer"  type.  As  printed  at  the  terminal,  the 
time  axis  runs  vertically  down  the  page  with  the  initial 
time  at  the  top- left  margin  and  time  points  printed  for  each 
sample  down  the  left  margin.  The  dependent  variables  are 
plotted  in  the  horizontal  sense  from  left  to  right  for 
increasing  magnitude.  Each  variable  plotted  is  marked  by  a 
distinct  number  (1  to  5)  at  each  sample  time.  In  the  event 
that  two  variables  occupy  the  same  location  in  the  plot 
field  at  the  sample  time,  only  the  plot  symbol  of  largest 
value  will  be  marked  at  the  point  in  question.  Such 
coincidences  of  position  can  be  inferred  from  the  behavior 
of  the  variable  with  missing  symbol  at  proximate  time 
samples.  Note  that  a  special  case  of  this  is  when  two  or 
more  variables  to  be  plotted  actually  represent  the  same 
variable. 

The  horizontal  width  of  the  plot  field  is  50  print 
positions.  The  scale  of  each  plot  is  printed  along  the 
bottom  margin  and  includes  the  values  of  the  grid  at  each 
multiple  of  10  print  positions.  In  the  usual  case,  each 
variable  is  plotted  on  its  own  unique  scale  and  thus  a  scale 
range  for  each  is  given  corresponding  to  the  plot  symbol 
used,  but  in  some  cases  only  a  single  scale  is  used  for  all 
variables  plotted  (i.e.,  anytime  that  the  model  output  is 
requested  to  be  plotted) .  Each  plot  will  include  an 
identifying  title  given  it  by  the  user. 


4.7  Summary 

This  chapter  has  discussed  the  CGT/PI/KF  design 
computer  program  by  giving  the  models  and  some  of  the 
characteristics  of  the  program.  Chapter  V  will  now 
demonstrate  the  use  of  the  program  to  design  CGT/PI/KF 
controllers.  A  complete  sample  run  for  a  simple  design 
problem  is  presented  in  the  User's  Guide,  Appendix  B.  The 
main  context  of  Chapter  V  will  be  a  comparison  of  the  four 
programs  developed  using  the  four  formulations  of  the  CGT/PI 


control  law 


Analysis  and  Comparison  of  Design  Results 


5.1  Introduction 

This  chapter  presents  the  results  of  the  design  and 
comparison  efforts  of  this  study.  The  design  model  upon 
which  the  analysis  and  comparisons  were  made  is  presented 
first.  A  baseline  is  then  established  by  using  the  design 
model  with  the  program  "CGTPIF"  (Refs  9  and  21) ,  which 
designs  a  CGT/PI  controller  with  the  PI  controller  based  on 
augmenting  the  original  state  equations  with  difference 
equations  for  control  variables,  treating  control  rates  as 
driving  functions,  instead  of  augmenting  the  original  state 
equations  with  the  integrals  of  regulation  error  as  done  in 
"CGTPIQ".  Only  explicit  model  following  is  pursued  in 
detail  in  this  study  since  another  thesis  effort  using 
"CGTPIF"  with  implicit  model  following  is  currently  underway 
(Ref  20)  and  the  results  of  that  study  are  not  available  yet 
for  comparison;  however,  it  is  anticipated  that  the 
formulation  in  this  thesis  may  be  very  useful  in  conjunction 
with  implicit  model  following,  particularly  since  the 
proportional  channel,  &p,  and  the  integral  channel, 

K^,  of  the  PI  controller  are  not  forced  to  be  equal. 

The  same  design  model  is  used  in  all  of  these  thesis  efforts 
to  provide  continuity  and  comparison.  (Note:  it  is 
recommended  that  this  thesis,  (Ref  20),  should  be  required 
reading  before  using  any  of  these  software  packages.  There 


were  software  errors  in  the  original  "CGTPIF"  program  (Refs 
9  and  21)  that  were  not  discovered  until  "CGTPIQ"  was 
programmed.  These  errors  have  now  been  corrected  in  the 
original  "CGTPIF".  Ref  (20)  documents  these  errors  and 
gives  a  good  insight  into  the  effects  of  these  errors  on 
program  execution.  Also,  the  results  of  using  implicit 
model  following  is  thoroughly  discussed  in  Ref  (20)).  This 
design  model  is  then  applied  to  the  four  programs  developed 
in  this  study  to  determine  the  characteristics  of  each.  A 
comparison  is  made  between  the  results  obtained  from  each  of 
the  four  programs  and  a  comparison  with  the  baseline 
analysis.  (The  four  programs  are  the  programs  which 
implement  the  four  formulations  for  the  closed- loop  CGT/PI 
discussed  in  Chapter  III,  Section  3.3.2.  All  four  of  these 
programs  employ  the  same  PI  controller.)  The  "best"  of  the 
four  programs  is  then  applied  to  a  simple  design  problem  in 
which  constant  disturbances,  an  alternate  truth  model  which 
represents  degraded  performance  due  to  misrepresentation  of 
system  dynamics  in  the  design  model,  and  initial  conditions 
are  applied  to  determine  if  this  "best"  design  program  can 
handle  these  situations.  All  designs  are  full-state 
feedback  designs  (no  Kalman  filter  in  the  loop).  The  tables 
and  time-response  plots  referred  to  in  this  chapter  have 
been  placed  together  at  the  end  of  the  chapter  to  make  the 
text  easier  to  read. 

5.2  Models 

A  CGT/PI  controller  for  the  Advanced  Fighter 


Technology  Integration  (AFTI)  F-16  was  chosen  as  the  example 
controller  to  be  designed  using  each  of  the  programs.  The 
AFTI  F-16  is  an  aircraft  which  has  been  modified  for 
advanced  flight  control  research.  Through  the  use  of  two 
independently  controlled  longitudinal  flight  control 
surfaces  (a  horizontal  tail  and  a  trailing  edge  wing  flap) , 
it  is  possible  to  achieve  direct  control  of  the  aircraft's 
pitch  attitude  without  changing  its  flight  path  angle  and, 
hence,  its  flight  trajectory.  This  capability  is  expected 
to  be  very  useful  in  situations  such  as  air-to-air  gunnery, 
in  which  the  attacker  must  match  the  target's  trajectory 
while  simultaneously  achieving  the  required  gun  lead  angle 
in  the  pitch  plane.  Such  a  design  was  of  interest  for  this 
study,  since  it  inherently  requires  the  use  of 
multiple- input  multiple-output  (MIMO)  design  methodology  to 
achieve  decoupled  control  of  the  two  outputs  and  maintain 
closed-loop  stability  with  a  plant  (the  F-16  aircraft)  which 
is  unstable. 

The  efforts  of  this  study  and  comparison  used  a 
five-state  design  model  for  the  AFTI  F-16  (Refs  8  and  9). 

The  model  represents  the  linearized  flight  characteristics 
of  the  aircraft  operating  at  0.8  roach  at  10,000  feet.  This 
particular  flight  condition  is  representative  of  an 
operating  point  within  the  usual  air-to-air  combat  flight 
regime.  Since  the  AFTI  F-16  is  unstable  in  pitch  in  this 
regime,  open- loop  CGT  designs  are  infeasible.  Therefore, 
only  CGT/PI  designs  were  pursued.  The  design  model  is  a 
time-invariant,  five  state  model  of  the  form 


£(t)  =  &s(t)  +  Bu(t) 


(V-l 


where  the  state  vector  x  consists  of 
x(l)  *  pitch  angle  (degrees) 
x(2)  *  angle  of  attack  (degrees) 
x(3)  =  pitch  rate  (degrees  per  second) 
x (4 )  =  horizontal  tail  deflection  (degrees) 
x (5)  =  trailing  edge  flap  deflection  (degrees) 
x(l)  -  x{2)  *  flight  path  angle  (degrees)  (v-2) 

and 
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(Note:  In  this  design  model,  actuators  are  represented  as 
having  characteristics  of  a  first-order  lag  response  to 
commands.)  The  outputs  are  expressed  as 
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indicating  that  the  outputs  of  interest  are  the  pitch  angle 
(yl»xl)  and  the  flight  path  angle  (y2=xl-x2).  The  limits  to 
be  considered  in  the  design  included  a  maximum  deflection  of 
25  degrees  in  either  direction  at  a  maximum  rate  of  60 
degrees  per  second  for  the  horizontal  tail,  and  +20  degrees 
to  >23  degrees  at  a  maximum  rate  of  52  degrees  per  second 
for  the  flap  (Ref  9). 


A  two  state  command  model  was  used  in  the  design 


with 
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and  D_  ■  0 .  The  command  model  was  chosen  to  represent 
-ra  — 

the  ideal  output  characteristics  of  decoupled  first-order 
responses  for  the  pitch  and  flight  path  angles. 
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The  design  analysis  consists  of  sets  of  time 
response  plots,  tables  of  PI  and  CGT/PI  gains,  and  PI  pole 
locations  for  several  different  sets  of  quadratic  weights 
applied  to  each  of  the  five  programs  (CGTPIF  and  the  four 
versions  of  CGTPIQ) . 

For  CGTPIF,  initial  quadratic  weights  of  one  each 
were  entered  for  output  deviations  (Y),  control  magnitude 
(OM) ,  control  rates  (UR),  and  the  (3,3)  element  of  the 
resultant  state  weighting  X  matrix  (to  limit  the  pitch  rate 
magnitude) .  Each  of  these  was  increased  one  at  a  time  to 
ten  and  another  set  of  time  response  plots  made.  By  noting 
the  effects  of  changing  the  weightings,  one  at  a  time,  the 
designer  will  get  a  feel  for  what  weights  to  apply  to  get 
the  effects  he  desires.  A  final  run  is  made  with  CGTPIF 
using  a  "best"  selected  set  of  weights.  Each  of  these  runs 
is  discussed  in  the  following  subsections.  (A  set  of  time 
response  plots  using  CGTPIF  consists  of  first  the  PI  time 
response  and  second  the  corresponding  CGT/PI  time  response 
using  the  just-determined  PI  gains.) 

For  CGTPIQ,  initial  quadratic  weights  of  one  were 
entered  for  output  deviations  (Y),  integral  of  the 
regulation  error  (UQ) ,  control  magnitudes  (UM) ,  and  the 
(3,3)  element  of  the  resultant  state  weighting  £  matrix. 
(Note:  the  selection  of  one  for  each  weight  has  no 
correlation  with  the  designs  using  CGTPIF  other  than  to  give 
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a  starting  point  for  the  discussion.)  Each  of  these  was 
increased  one  at  a  time  to  ten  and  another  set  of  time 
response  plots  made.  Again,  by  noting  the  effects  of 
changing  the  weightings,  one  at  a  time,  the  designer  will 
get  a  feel  for  what  weights  to  apply  to  get  the  effects  he 
desires.  Three  additional  runs  were  made  using  CGTPIQ.  The 
first  was  obtained  by  using  the  same  set  of  weights  as  the 
"best”  run  made  using  CGTPIF  with  the  weights  for  UR  in 
CGTPIP  applied  to  UQ  in  CGTPIQ,  all  other  weights  remaining 
the  same.  This  was  done  to  see  if  in  fact  there  was  any 
direct  correlation  between  the  two  designs.  The  second  was 
achieved  by  applying  weights  to  every  diagonal  element  in 
the  X  matrix  (i.e.,  adding  quadratic  cost  associated  with 
the  two  actuator  states.  A  weight  of  one  was  arbitrarily 
selected  for  each  of  these.)  and  the  third  by  applying 
explicit  and  implicit  weights  just  to  see  the  effect.  (A 
set  of  time  responses  using  CGTPIQ  consists  first  of  the  PI 
time  response  followed  by  four  CGT/PI  time  responses  using 
each  of  the  four  formulations  presented  in  Chapter  III,  each 
based  on  the  same  set  of  PI  gains  just  determined.) 

All  PI  time  response  plots  represent  the  same  four 
variables.  Symbol  '1'  represents  the  pitch  angle,  symbol 
'2'  the  flight  path  angle,  '3*  is  the  position  of  the 
horizontal  tail  and  '4'  is  the  position  of  the  trailing  edge 
flaps.  Each  PI  time  response  represents  the  response  to  an 
initial  condition  of  one  degree  in  the  pitch  angle  state. 

All  CGT/PI  time  response  plots  represent  the  same 
three  variables.  Symbol  '1'  represents  the  pitch  angle, 


symbol  *2'  is  the  model  output  that  the  pitch  angle  is  to 
follow,  and  '3'  is  the  flight  path  angle  which  is  desired  to 
stay  at  zero.  Each  CGT/PI  time  response  represents  the 
response  to  a  step  input  of  magnitude  one  for  the  model. 

All  state  initial  conditions  are  zero  for  the  CGT/PI. 

5.3.2  CGTPIF  Baseline  Design 

The  baseline  design  using  CGTPIF  is  shown  in  Figures 
V-l  through  V-12  and  in  Table  V-l.  Figure  V-l  represents 
the  PI  controller  for  quadratic  weight  set  (abbreviated  QWS 
in  all  of  the  figures)  number  one  of  Table  V-l.  Figure  V-2 
is  the  corresponding  CGT/PI  for  the  same  quadratic  weight 
set.  Figures  V-3  and  V-4  are  the  PI  and  CGT/PI, 
respectively,  corresponding  to  quadratic  weight  set  number 
two  of  Table  V-l.  This  two  plot  set  for  one  quadratic 
weight  set  correspondence  continues  up  to  Figures  v-11  and 
V-12  corresponding  to  quadratic  weight  set  six  of  Table  V-l. 

Observation  of  the  CGT/PI  performance  for  all  six 
sets  of  quadratic  weights  indicates  a  good  model  following 
of  the  pitch  angle  (there  are  slight  differences  in  the 
transient  performance  of  each)  with  very  little  deviation  in 
the  flight  path  angle.  Therefore,  the  only  observations 
that  will  be  discussed  in  detail  is  how  the  quadratic 
weights  affected  the  motion  of  the  horizontal  tail  and 
trailing  edge  flap  to  achieve  this  good  model  following  of 
the  CGT/PI.  To  determine  this  we  need  to  look  at  the  PI 
time  response  for  each  set  of  quadratic  weights.  Figure  V-l 
will  be  used  as  a  base  to  judge  the  effects  of  increasing 


each  quadratic  weight. 

Increasing  the  weight  on  the  output  deviation  (Y) 
had  very  slight  effect  on  the  performance,  as  shown  in 
Figure  V-3,  but  did  show  a  slight  decrease  in  rise  time  with 
a  corresponding  larger  overshoot  as  would  be  expected. 

(Note:  due  to  the  effects  of  scaling  of  each  variable  on  a 
time  response  plot,  the  designer  will  need  to  be  careful,  in 
that,  what  looks  to  be  a  "better"  or  "worse"  response  may 
just  be  due  to  a  different  scale  for  that  variable  from  one 
run  to  the  next.  This  is  not  that  critical  for  this  first 
comparison  but  is  critical  on  some  of  the  other  CGT/PI  time 
response  plots.) 

Increasing  the  weight  on  the  (3,3)  element  of  the  £ 
weighting  matrix  (i.e.,  on  pitch  rate)  again  had  very  little 
effect,  as  shown  in  Figure  V-5,  but  did  decrease  the  rise 
time  and  settling  time,  as  expected,  with  a  corresponding 
greater  overshoot. 

Increasing  the  weight  on  the  control  magnitude  (UM) 
had  the  effect  of  slowing  down  the  horizontal  tail  motion 
but  greatly  increasing  the  speed  and  deflection  of  the 
trailing  edge  flap  as  shown  in  Figure  V-7.  This  difference 
in  effect  on  the  two  control  surfaces  was  not  expected  since 
weighting  the  control  for  each  should  have  allowed  each  to 
move  faster  and  further  initially. 

Increasing  the  weight  on  the  control  rate  (UR)  had 
the  effect  of  slowing  down  both  the  tail  and  flap  motion  as 
expected,  producing  very  little  overshoot  with  trailing  edge 
flap  motion  almost  within  tolerance  limits  as  shown  in 
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As  a  last  set  o£  quadratic  weights  to  be  used  which 
were  considered  the  "best"  for  this  application,  the  weights 
(Y)  and  X(3,3)  were  increased  to  decrease  the  rise  time, 
thereby  speeding  up  the  motion  of  the  flaps  and  tail,  but  at 
the  same  time  the  weight  (UR)  was  increased  to  limit  the 
deflection  and  overshoot  of  each.  This  combination  produced 
flap  and  tail  motion  that  stayed  in  limits  and  gave  good 
model  following  characteristics  to  the  CGT/PI  while 
maintaining  the  flight  path  angle  near  zero,  as  shown  in 
Figures  V-ll  and  v-12. 

The  corresponding  PI  pole  motion  for  each  of  the 
sets  of  quadratic  weights  is  shown  in  Table  V-l  along  with 
the  corresponding  PI  and  CGT/PI  gains  needed  to  produce  the 
responses  noted.  The  PI  pole  motion  may  give  insight  into 
design  characteristics  but  this  is  not  discussed  here.  The 
pole  locations  are  included  in  the  table  since  some 
readers/designers  may  wish  to  know  this  information. 

5.3.3  CGTPIQ  Design  Analysis 

The  design  and  comparisons  using  the  four  versions 
of  CGTPIQ  are  presented  in  Figures  V-13  through  V-52  and 
Table  V-2.  There  are  eight  sets  of  five  time  response 
plots.  The  first  plot  of  each  set  is  the  PI  time  response 
for  the  set  of  quadratic  weights  shown  in  Table  V-2.  Plot 
two  of  each  set  is  the  CGT/PI  time  response  produced  using 
CGT/PI  formulation  1.  Similarly,  the  third,  fourth  and 
fifth  plots  of  each  set  are  the  CGT/PI  time  responses 


produced  using  C6T/PI  formulations  2,  3,  and  4, 
respectively.  Each  CGT/PI  is  based  on  the  same  PI  gains 
previously  determined  for  that  set. 

The  determination  of  a  "best"  CGT/PI  out  of  the  four 
possible  will  be  the  one  that  most  closely  approaches  the 
performance  noted  by  using  CGTPIF.  This  was  very  easy  to 
determine,  for,  if  we  notice,  every  CGT/PI  based  on 
formulations  1  and  2,  no  matter  what  the  quadratic  weights 
were  that  were  applied  to  the  PI,  showed  an  inherent  lag 
between  model  output  and  system  output.  This  lag  was 
greater  for  the  CGT/PI  based  on  formulation  2.  (If  we 
recall  from  Chapter  III,  this  was  not  supposed  to  be  the 
case  when  comparing  these  two.  The  cause  of  this 
characteristic  is  not  yet  resolved.)  The  CGT/PI  based  on 
CGT/PI  formulation  3  showed  an  inherent  overshoot  due  to 
faster  transient  performance  for  all  quadratic  weight  sets. 
This  was  to  be  expected,  as  noted  in  Chapter  III,  due  to  the 
extra  gain,  £,  providing  a  direct  feedthrough  of  the  input. 
Only  the  ad-hoc  formulation  4  (based  on  neglecting  the 
terms,  from  formulation  3  which  produced  a  fast 

transient  and  also  the  term,  N,  from  formulation  2,  which 
turns  out  to  be  the  term  which  slows  down  the  transient 
response)  yields  a  CGT/PI  controller  that  appears  to  give 
satisfactory  performance  (satisfactory  in  the  sense  that  it 
most  closely  approaches  the  performance  noted  using  CGTPIF) 
for  a  given  PI  set  of  quadratic  weights.  What  we  need  to 
look  at  now  is  what  effect  the  different  sets  of  quadratic 
weights,  as  presented  in  Table  V-2,  have  on  the  PI 
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performance. 

We  will  use  Figure  V-13,  which  is  the  PI  time 
response  based  on  quadratic  weight  set  1  of  Table  V-2,  as 
the  base  from  which  to  determine  the  effects  of  increasing 
each  quadratic  weight.  The  first  thing  that  is  noted  in 
looking  at  Figure  V-13  is  the  much  slower  response  of  this 
PI  controller  compared  to  the  one  used  in  CGTPIF.  This 
slowness  shows  in  every  PI  time  response  for  every  set  of 
quadratic  weights.  (This  may  or  may  not  be  a  good  trait 
depending  on  the  desires  of  the  designer.)  But,  at  the  same 
time,  it  is  noted  that  the  motion  of  the  flaps  and  tail  are 
not  nearly  as  harsh  as  in  the  Pi  controller  produced  by 
CGTPIF.  This  would  be  important  for  saturation  concerns  and 
for  robustness  (these  issues  are  amoung  those  being 
investigated  by  Capt  Miller,  Ref  (20),  using  the  program 
"CGTPIF") . 

Increasing  the  weight  on  the  output  deviation  (Y) 
had  very  little  effect  on  the  system  as  shown  in  Figure 
V-18.  This  same  response  was  noted  using  CGTPIF  as 
mentioned  in  the  previous  section. 

Increasing  the  weight  on  the  (3,3)  element  of  the  X. 
matrix  had  a  very  definite  slowing  effect  on  the  system  and 
the  coresponding  reduction  in  overshoot  as  shown  in  Figure 
V-23.  This  was  as  expected  due  to  the  increased  weight  on 
the  pitch  rate.  Also,  the  motion  of  the  horizontal  tail  is 
not  nearly  as  smooth. 

Increasing  the  weight  on  the  integral  of  the 
regulation  error  (UQ)  had  the  effect  of  speeding  up  the 
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system  with  the  corresponding  overshoot  produced,  as  shown 
in  Figure  V-28.  (All  things  considered,  this  is  not  a  bad 
PI  design  in  itself  and  it  produces  acceptable  CGT/PI 
performance  as  shown  in  Figure  V-32.) 

Increasing  the  weight  on  the  control  magnitude  (UM) 
had  the  effect  of  greatly  slowing  down  the  system,  as 
expected,  with  the  motion  of  the  flap  and  tail  greatly 
reduced,  as  shown  in  Figure  V-33. 

Figure  V-38  shows  the  PI  time  response  for  the  same 
set  of  quadratic  weights  as  the  "best”  design  using  CGTPIF. 
In  this  case  this  is  not  a  bad  design  either  as  response 
time  is  reasonable  and  flap  and  tail  motion  are  maintained 
within  the  required  limits.  The  CGT/PI  also  shows 
satisfactory  results  with  good  model  following  and  flight 
path  angle  deviations  very  slight,  as  shown  in  Figure  V-4?. 
The  purpose  of  this  test  was  to  determine  if  there  was  a 
weight  that  could  be  applied  to  UQ,  all  other  weights 
remaining  the  same  as  in  CGTPIF,  that  would  produce  a 
response  exactly  like  that  obtained  using  CGTPIF.  Although 
the  response  was  similar,  we  were  not  able  to  find  a  weight 
for  UQ  that  would  produce  the  exact  results. 

The  last  two  sets  of  quadratic  weights  were  used  to 
determine  if  perhaps  additional  weights  could  be  added, 
either  manually  in  the  £  matrix  or  by  using  implicit 
weights,  which  also  fills  in  the  £  matrix  with  off-diagonal 
elements,  to  improve  the  performance  of  the  PI  controller 
(making  it  more  closely  approximate  the  good  performance  as 
seen  using  CGTPIF) .  Nothing  spectacular  was  noted  in  these 
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two  as  shown  in  Figures  V-43  and  V-48  but  it  was  noted  that 
adding  small  implicit  weights  did  give  performance  similar 
to  that  obtained  by  manually  adding  additional  weights  in 
the  £  matrix,  thereby  relieving  the  designer  of  the  burden 
of  guessing  weights  to  add.  This  is  an  expected 
characteristic  of  using  implicit  model  following. 

The  corresponding  PI  pole  motion  for  each  of  the 
sets  of  quadratic  weights  is  shown  in  Table  V-2  along  with 
the  corresponding  PI  and  C6T/PI  gains  needed  to  produce  the 
responses  noted.  The  PI  proportional  gains,  and 
integral  gains,  are  also  listed.  As  expected,  they 
are  different,  and  therefore  are  a  potentially  very  useful 
tool  in  design  work.  By  being  able  to  adjust  the 
proportional  and  integral  gains,  the  designer  would  be  able 
to  compensate  for  a  bad  trait  of  PI  controllers  known  as 
wind-up.  This  was  not  investigated  in  this  study  and  is 
left  for  follow-on  work. 


5.4  Simple  Design  Problem  Using  CGT/PI  Formulation  4 


Since  CGT/PI  formulation  4  was  shown  to  be  a 
candidate  for  a  good  CGT/PI  controller,  it  was  decided  to 
test  this  controller's  performance  against  adverse 
conditions.  A  simple  design  problem  was  selected  that 
contained  disturbance  states,  an  alternate  truth  model  used 
to  evaluate  the  degradation  in  per f romance  due  to 
misrepresented  system  dynamics  in  the  design  model,  and 
initial  conditions.  ’his  is  the  same  simple  design  model  as 
presented  in  FJ'./d's  thesis  (Ref  9),  and  is  presented  here 
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Figure  V-53  shows  an  open- loop  CGT  design  (1  is  the 
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system  output  and  2  is  the  command  model  output)  to 
demonstrate  the  effects  of  adding  the  PI  feedback  controller 
design  of  Figure  V-54  (1  is  state  x2,  2  is  the  system 
output,  and  3  is  the  applied  control) .  Figure  V-55  shows 
the  improved  performance  of  the  closed- loop  CGT/PI  over  the 
open-loop  CGT.  This  figure  is  based  on  the  first  order 
command  model  (CM01) .  When  the  same  PI  controller  is 
applied,  and  the  second  order  command  model  (CM02)  selected, 
the  performance  is  drastically  improved  as  shown  in  Figure 
V-56.  (There  is  no  difference  between  model  and  system 
outputs.)  These  last  four  time  response  plots  are  based  on 
the  nominal  truth  model.  Figure  V-57  shows  the  effect  on 
the  CGT/PI  of  adding  a  constant  disturbance  and  Figure  V-58 
shows  the  effect  of  not  only  having  disturbances  but  also 
the  alternate  truth  model.  The  performance  of  these  two 
CGT/PI  controllers  compares  favorable  with  that  obtained  by 
Floyd  when  using  the  program  "CGTPIF"  (Ref  9).  As  a  final 
test.  Figure  V-59  adds  initial  conditions  to  the  design  with 
disturbance  and  alternate  truth  model.  Note  the  CGT/PI 
controller  takes  a  little  time  to  recover  from  all  the 
discrepancies,  but  it  does  recover  and  gives  good 
performance  as  steady-state  conditions  are  approached. 

5 . 5  Summary 

Chapter  V  has  presented  and  compared  each  of  the  PI 
and  CGT/PI  controllers  discussed  in  this  thesis  through  use 
of  the  programs  which  were  developed  to  implement  them.  A 
comparison  was  also  made  with  the  original  program  "CGTPIF". 


Initial  indications  are  that  the  program  "CGTPIF"  has 
certain  advantages  over  "CGTPIQ"  in  that  it  offers  greater 
control  over  the  PI  controller,  but  this  does  not 
necessarily  mean  better  performance  in  the  CGT/PI  controller 
when  we  note  the  performance  due  to  CGT/PI  formulation  4. 
This  particular  CGT/PI  controller  was  shown  to  be  able  to 
generate  designs  with  desirable  closed- loop  characteristics 
and  to  handle  adverse  conditions  just  as  well  as  the  CGT/PI 
controller  implemented  in  the  program  "CGTPIF". 
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Figure  V-2.  CGT/PI  for  QWS-1  (CGTPIF) 
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Figure  V-17.  CGT/PI-4  for  QWS- 
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Figure  V-19.  CGT/PI-1  for  QWS- 
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Figure  V-28.  PI  for  QWS- 
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Figure  V-29.  CGT/PI-1  for  QWS- 
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Figure  V-31.  CGT/PI-3  for  QWS- 
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Figure  V-33.  PI  for  QWS- 
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Figure  V-34.  CGT/PI-1  for  QWS- 
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igure  V-52.  CGT/PI 
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Figure  V-55.  Simple  Design  CGT/PI  (no  disturbances,  nominal  truth  model 
command  model  1) 


igure  V-56.  Simple  Design  CGT/PI  {no  disturbances,  nominal  truth  model 
command  model  2) 
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Simple  Design  CGT/PI  (constant  disturbances,  alternate  truth 
model,  command  model  2) 
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Figure  V-59.  Simple  Design  CGT/PI  (constant  disturbances,  alternate  truth 
model,  initial  conditions,  command  model  2) 
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VI.  Summary  and  Recommendations 


6.1  Summary 

The  £irst  primary  objective  of  this  thesis  has  been 
to  develop  an  interactive ,  user-or iented  computer  program 
similar  to  "CGTPIF"  (Refs  9  and  21),  which  will  also 
interface  with  "PFEVAL"  (Ref  21) ,  to  aid  in  the  design  of 
CGT/PI/KF  controllers,  basing  the  design  of  the  PI 
controller  on  the  integral  of  the  regulation  error. 

Secondly,  the  design  program  was  to  be  applied  to  an 
aircraft  flight  control  problem  to  evaluate  characteristics 
of  this  PI  controller  design,  to  compare  the  different 
CGT/PI  designs  within  CGTPIQ,  and  to  compare  CGTPIQ  with 
CGTPIF. 

Chapter  II  introduced  the  CGT/PI/KF  controller 
concept  by  briefly  summarizing  what  is  currently  implemented 
in  the  interactive  computer  programs  "CGTPIF"  and  "PFEVAL". 
The  basic  structure  of  the  controller  and  the  development  of 
the  necessary  equations  were  presented. 

Chapter  III  presented  the  theoretical  development  of 
the  alternate  PI  and  CGT/PI  controller  based  on  the  integral 
of  the  regulation  error.  Four  different  formulations  were 
presented  and  discussed  for  this  CGT/PI  controller.  Each  of 
these  CGT/PI  controllers  were  eventually  implemented  in  code 
and  compared. 

Chapter  IV  discussed  the  CGT/PI/KF  design  computer 


VI-1 


program  that  was  developed  and  gave  the  models  that  were 
employed  in  the  design. 

Chapter  V  presented  and  compared  each  of  the  PI  and 
CGT/PI  controllers  discussed  in  Chapters  II  and  III  through 
use  of  the  programs  which  were  developed  to  implement  them. 
General  comments  were  made  as  to  the  usefulness  of  each 
program. 

Appendix  A  is  the  CGTPIQ  programmer's  guide  and 
contains  a  discussion  of  only  those  subroutines  that  were 
changed  in  "CGTPIF11  to  produce  "CGTPIQ". 

Appendix  B  is  a  complete,  stand-alone,  user's  guide 
that  contains  all  the  information  needed  by  the  user  of 
"CGTPIQ"  to  run  the  program  successfully. 

Appendix  C  is  a  complete  listing  of  the  program 
"CGTPIQ"  as  well  as  a  listing  of  the  subroutines  that  were 
changed  for  each  of  the  CGT/PI  formulations  presented  in 
Chapter  III. 

Appendix  D  contains  a  discussion  of  the  CGT/PI/KF 
design  evaluation  equations  that  are  used  in  "CGTPIQ". 

6.2  Recommendations 

During  the  development  of  the  alternate  PI 
controller  equations,  concepts  such  as  better  anti-windup 
capabilities  due  to  separate  proportional  and  integral  gain 
channels  and  implicit  model  following  were  presented.  As  a 
follow-on  study,  these  concepts  could  be  thoroughly 
investigated  using  the  program  "CGTPIQ".  Also,  synthesis 
and  analysis  of  complete  CGT/PI/KF  controllers  (i.e.  with 


Kalman  filters  in  the  loop  rather  than  assuming  full  state 
feedback)  using  the  programs  "CGTPIQ"  and  "PFEVAL"  could  be 
performed,  to  include:  robustness  characteristics,  actuator 
saturation  and  associated  windup  phenomenon  with  a  PI 
controller,  reduced  order  design  models  (particularly 
actuator  models  and  neglected  bending/aeroelastic  effects), 
and  different  equlibrium  points  for  expansion  of  the 
linearized  models.  A  similar  study  by  Lt.  Jean  Howey  using 
the  programs  "CGTPIF"  and  "PFEVAL"  is  currently  underway 
("Robust  Flight  Controllers".  MS  Thesis.  Air  Force 
Institute  of  Technology,  Wr ight-Patterson  afb ,  Ohio, 
December,  1983).  It  would  also  be  useful  to  explore  more 
fully  the  relative  benefits  of  the  two  different  types  of  PI 
designs  embodied  in  "CGTPIQ*  vs  "CGTPIF",  considering  ease 
of  achieving  useful  designs,  capabilities  to  enhance 
robustness  of  the  full-state  feedback  controller  as  well  as 
CGT/PI/KF  controllers,  and  other  pertinent  issues.  As  an 
additional  area  of  endeavor,  the  two  programs,  "CGTPIF"  and 
"CGTPIQ",  could  be  combined  into  one  program  using  the 
concepts  presented  in  Ref  (18)  for  a  PIF  controller.  It 
would  also  be  worthwhile  for  the  entire  man-machine 
interface  (i.e.,  put  the  pilot  in  the  loop  with  the 
CGT/PI/KF  controller)  to  be  implemented  in  a  computer 
program  to  understand  the  inter-relationships  of  the  overall 
system. 
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A.l  Introduction 

CGTPIQ  is  a  controller  design  program  in  which  the 
PI  controller  is  based  on  the  integral  of  the  regulation 
error.  The  program  is  designed  to  execute  interactively. 
Three  design  paths  are  offered:  (1)  design  of  a 
Proportional-plus-integral  (PI)  controller  via 
linear-quadratic  (LQ)  methodology  using  implicit  and/or 
explicit  quadratic  weights;  (2)  design  of  a  Command 
Generator  Tracker,  either  open- loop  (CGT)  or  closed- loop 
(CGT/PI);  and  (3)  design  of  a  Kalman  filter  (KF) .  These 
three  designs  are  components  of  a  final  controller 
implemented  as  a  Command  Generator  Tracker,  with  an 
inner-loop  proportional-plus-integral  controller,  and  a 
Kalman  filter  for  state  estimation  (CGT/PI/KF) .  For  each 
design  path  there  is  a  corresponding  set  of  routines  to 
evaluate  the  quality  of  the  design  achieved  (see  Appendix 
D) . 

The  program  is  written  in  FORTRAN  IV  and  consists  of 
more  than  2900  lines  of  source  code.  In  addition,  numerous 
routines  are  employed  from  a  library  of  matrix  routines 
described  in  Ref  (12).  Since  the  resulting  program  is  large 
both  in  code  and  in  memory  utilization  for  array  storage, 
direct  and  complete  loading  of  the  program  exceeds  memory 
limits  for  interactive  execution  on  the  ASD  CYBER  computer 


system.  A  technique  referred  to  as  "segmentation"  is 
employed  to  provide  selective  loading  of  routines  during 
execution  so  that  memory  usage  remains  within  the  limits  for 
interactive  execution. 

This  guide  is  a  brief  discussion  of  the  subroutines 
that  were  changed  in  converting  the  program  written  by  Floyd 
(Ref  9),  as  modified  by  Moseley  (Ref  21),  called  "CGTPIF"  to 


the  program  called  "CGTPIQ"  which  bases  the  PI  controller  on 
the  integral  of  the  regulation  error  instead  of  the  control 
difference  or  "pseudorate"  as  done  in  "CGTPIF".  The 
equations  presented  in  this  guide  reflect  the  development 
presented  in  Chapter  III  (only  CGT/PI  formulation  1,  Section 
3. 3. 2.1  is  presented  in  detail).  Since  the  two  programs  are 
exactly  alike  except  for  a  few  subroutines,  it  is  felt  that 
repeating  the  entire  development  presented  in  Floyd's  and 


Moseley's  theses  would  not  be  required  by  most  users.  If 
the  user  wishes  to  understand  the  entire  program  development 
he  should  obtain  copies  of  Floyd's  and  Moseley's  theses 
(Refs  9  and  21),  and  taking  their  development  along  with  the 
changes  presented  in  this  guide,  a  complete  description  of 
the  program  will  be  available. 

In  converting  CGTPIF  to  CGTPIQ  major  changes  were 
made  to  subroutines  CDIF,  SREGPI,  WXUS,  FORMX  (name  also 
changed  to  FORMXU),  CGTKX,  and  MODIFX  (name  also  changed  to 
MODXU)  with  minor  changes  made  to  MAIN,  CGTXQ ,  UCGT,  and 
SCMD.  There  were  also  numerous  cosmetic  changes  made  so 
that  the  program  elements  sounded  like  what  they  were 
actually  representing.  All  of  these  changes  will  be 


m 
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presented  in  the  following  sections 


A. 2  Program  Changes 

A. 2.1  CD IF 

*CDIF *  is  called  by  the  subroutine  'PIMTX'.  'CDIF' 
sets  up  two  augmented  matrices  for  the  integral  of  the 
regulation  error  PI  controller.  These  matrices  are: 


0 

I 


(A-la) 


(A-lb) 


^  and  ^  are  stored  in  vector  CTL  of  /CONTROL/. 


A. 2. 2  SREGPI ,  WXUS,  and  FORMXP 

Computations  involved  in  the  design  of  the  PI 
controller  are  directed  by  routine  SREGPI.  Routine  'WXUS' 
is  called  first  to  determine  the  quadratic  weighting 
matrices  of  the  discrete-time  optimal  cost  function  from  the 
continuous-time  input  quadratic  weights.  Quadratic 
weighting  matrices  (assumed  diagonal)  are  entered  directly 
by  the  user  from  the  terminal  for  costs  assigned  to  output, 
integral  of  the  regulation  error,  and  control  magnitudes — £, 
U  ,  and  H  respectively.  These  matrices  are  stored 

q  y 

in  vector  "RPI*  of  /CREGPI/.  An  augmented  perturbation 
state  vector  is  defined  to  be 


A  weighting  matrix  on  the  state  vector  £  is  formed  as 


Sell 


ctyq 


Xc22  *  2q 

*cl2  *  SL 


(A-3a 

(A-3b 

(A-3c 


Routine  'FORMXU'  performs  these  computations  and  forms 
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where 
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The  user  is  then  given  the  opportunity  to  modify  individual 
elements  of  &  (symmetry  is  preserved  automatically  by  WXUS) 
as  for  instance,  to  alter  individual  diagonal  elements  of 


A-4 


Xc^^.  The  associated  continuous- time  cost  function  is. 


rc  ■  lim  ps(t)T‘  rxc  Sl  r s(tij  at 

X  La(t)i  LScT  2cJ[uU)_ 


where 
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u  *  /u 

-c  "  f^cll  £c!2 


-cl  2  ^c2  2 


where  q  is  the  integral  of  the  regulation  error.  The 
corresponding  discrete-time  cost  function  is  defined  by 

N 

j  3 ^iixT(ti)xJi<ti)  +  uT(ti)Ufsi(t.) 

1,0  +  2jiT(ti)S/u(ti)] 

and  the  discrete  costs  are, 

X,  -j£itT  HfT(f)Xclf(t')]df  ( 

2 1  m£*T  I^|TCtr)XcB|(r)  +  uc  +  a*T(t:)£c 

+SCTS  ('Old'C  ( 
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in  which 


'*  «• 


The  integrals  in  Equations  (A-8a,b,c)  are  approximated  in  a 
two-step  computation.  First,  #f  and  are  treated  as 
constants  over  the  sample  interval  with  value  set  to  their 
respective  averaged  values  at  the  beginning  and  end  of  the 
interval: 

If  *  iH  +  if!  (A-lOa) 

If  -  -^10  +  fif  1  (A-lOb) 

(where  the  overbar  means  approximation)  in  which  and  Bj 
are  as  defined  in  Equations  (A-la,b) .  With  these 
approximations,  each  of  the  integrands  is  constant  over  the 
integration  time  T,  so  the  integrals  are  obtained  as 

Xf*  TtiJxfj  ]  (A-lla) 

2f“  T[IfTXfff  +  Uc  +  IfTSc  +  SCTI;  ]  (A-llb) 

3f»  TllJ’ilf  +  I^ac]  (A— lie) 

This  provides  a  better  approximate  evaluation  than  simple 
Euler  integration  provides.  These  three  discrete-time  costs 
are  returned  by  ’WXUS'  as  arguments  "X",  "u",  and  "S", 
respectively. 


[;? 
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Note  that  the  cross  weighting  matrix  ^  has  been 
introduced  into  the  cost  function  by  the  discretization 
process  and  will  generally  be  nonzero  even  if  S_  in 

C 

Equation  (A-6)  were  zero.  This  cost  function  is  seen  to  be 
in  the  standard  form  used  previously  and  all  development  can 
proceed  as  if  the  problem  were  a  discrete  problem  and  not  a 
continuous  one. 

Now,  in  order  to  obtain  an  equivalent  discrete-time 
cost  function  with  no  cross  weighting  (to  allow  use  of 
standard  Riccati  equation  solvers  as  in  Ref  (12)  that  assume 
such  a  form) ,  routine  ’PXUP*  is  called  to  compute  a  modified 
system  and  weighting  matrices.  Define  a  new  system  (Ref  14) 


-(ti+l>  +  IjU'  ( t ±) 


(A-12) 


for  which 


is '  -  Is  -  Ij2j~1SJT 


(A-13a) 


and 


u'(ti)  *  u(ti)  +  I4"1IjTx(ti) 


(A-13b) 


for  which  the  corresponding  cost  function  becomes 
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with 
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(A-15) 
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The  cost  function  of  Equation  (a-14)  is  now  in  standard  form 

for  solution  of  the  steady-state  Riccati  equation.  PXUP 

—1—  T 

returns  matrices  ' ,  and  of  Equations 

(A-13a) ,  (A-15),  and  (A-13b) ,  respectively.  An  additional 
matrix  needed  for  the  routine  which  computes  the  solution  to 
the  Riccati  equation  is  also  computed  by  PXUP: 


3,’  -  IjSj'V 


(A-16) 


SREGPI  next  computes  the  steady-state  solution  to 
the  discrete-time  Riccati  equation  using  routine  'DRIC'  of 
LIBRARY.  DRIC  solves  for  £R  in 


-R  -  vVi^v'V  +  V 


(A-17) 


using  an  iterative  procedure  discussed  in  Ref  (12).  In 
addition  to  KR,  DRIC  returns  the  closed-loop  system 
matrix 


I,CL  -  (I  +  Sx'Kp)"1!^ 


‘-t  -R 


(A-18) 


which  is  stored  in  vector  RPI. 

Routine  'GCSTAR'  then  is  called  to  compute  the 
optimal  feedback  gain  matrix  for  the  original  system.  The 
optimal  feedback  gains  for  the  modified  system  of  Equation 


■  v' 


(A-12)  are. 


Sc*'  *  10,  +  I,T£RBir1i,'riSRI,’  (A-19) 

and  from  these  the  optimal  feedback  gains  for  the  original 
system  are 


*  *  _  _  rn 

Sc  -  •  +  2 i  V 


(A-20) 


Remembering  from  Equation  (III-25)  that 


Sc*  ■  lscl*  Sc2*l  (A-21) 

the  calculation  beginning  with  a  continuous* time  cost 

* 

description  will  produce  the  correct  G  .  The  only 

c 

question  that  might  arise  is  whether  the  substitution  of 
H  '  for  K  is  a  valid  substitution.  This  will  be 

K  w 

shown  in  the  last  section  of  this  guide.  The  PI  controller 
in  incremental  form  utilizing  these  gains  is  implemented  as 


u  ( t 


u  ( t i—1 )  -  Gcl  tx(ti)  -  x(ti-;L)] 


-  Sc2  [Q  BJ 


(A-22) 


The  controller  evaluation  routines  which  propagate 
the  response  of  the  PI  controlled  system  to  non-zero  initial 
conditions  use  Equation  (A-22)  to  compute  the  control  input. 
Note  that  this  assumes  that  the  outputs  are  to  be  driven  to 


A-9 


zero  by  the  PI  controller.  No  provision  is  made  for 
evaluation  of  the  PI  controller  in  response  to  control 
inputs/  therefore/  y^  will  be  zero  for  all  time.  Thus 
the  matrix  E  is  not  required  in  the  computation/  but  is 
computed  and  saved  in  vector  LEE  of  /LREGPI/  so  that  a 
comparison  can  be  made  between  the  proportional  and  integral 
channels  of  the  PI  controller  according  to 

K  -  II  -  ED  ]-1E  (A-23a) 

~P  ”  — y 

Ki  *  II  -  ED  ]-1Gc2*  (A-23b) 


(These  are  computed  at  the  end  of  SREGPI.)  and  since  a  major 
portion  of  E.  known  as  the  L  matrix  where 


L  *  ficl  -  Sc2  — c22  1-c12T 


(A-23c) 


is  needed  in  the  closed-loop  CGT/PI  controller  development. 
The  L  matrix  is  saved  in  vector  LEL  of  /LREGPI/.  (See 
Section  3.3.2  for  changes  for  CGT/PI  formulations  2/3f4.) 


A. 2. 3  CGTKX  and  SCMD 

SCGT  directs  the  computations  involved  in  design  of 

an  open- loop  CGT  or  closed- loop  CGT/PI  controller.  SCGT 

calls  routine  CGTKX  to  compute  the  gains  employed  by  the  CGT 

and  CGT/PI  controllers.  For  the  open- loop  CGT  controller 

*  * 

routine  SCMD  sets  matrices  gcl  and  Gc2  to 

zero.  CGTKX  computes  gains  on  command  model  states  and 

inputs  and  disturbance  states,  respectively,  as 


1  ft' 
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--12  +  ^22 
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(A-24a) 

(A-24b) 

(A-24c) 


These  three  gains  are  stored  in  vector  CGT.  (See  Section 
3.3.2  for  changes  for  CGT/PI  formulations  2,3,4.) 

The  closed- loop  CGT/PI  control  law  is  implemented  in 
incremental  form  as 


u  (t^ 
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(See  Section  3.3.2  for  changes  for  CGT/PI  formulations 

2,3,4.)  The  open-loop  CGT  is  obtained  by  employing  Equation 

*  * 

(A-25)  with  PI  gains  2cl  and  Sc2  both  zeco 

matrices,  giving  the  effective  result  for  the  open- loop  CGT 

control  law  as 
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Equation  (A-25)  is  used  by  the  controller  evaluation 
routines  to  compute  control  inputs  for  either  CGT 
controller . 


A. 2. 4  OCGT 

UCGT  computes  the  control  input  due  to  the  CGT 
controller  alone  and  adds  it  to  the  control  given  by  the  PI 
controller  from  URPI.  The  increment  due  to  the  CGT  or 
CGT/PI  alone  is  added  as 
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(See  Section  3.3.2  for  changes  for  CGT/PI  formulations 
2,3,4.) 


A. 2. 5  MOD XU 

MODXU  computes  the  combined  implicit/explicit 
quadratic  weights  according  to 


A. 2. 6  MAIN  and  CGTXQ 

MAIN  is  changed  by  increasing  the  storage  space 
allotted  to  common  /CREGPI/  and  vector  NVRPI  to  675  to  take 
care  of  the  two  added  matrices  L  and 

CGTXQ  is  changed  by  adding  vector  space  for  matrices 
L  and  E.  in  Common  /LREGPI/.  These  are  called  LEL  and  LEE, 
respectively. 

A. 2. 7  Cosmetic  Changes 

All  reference  to  the  vector  notation  on  the  left  has 
been  changed  to  the  notation  on  the  right 
KX  -  GCl 

KZ  -  GC2 

LKX  -  LGC1 

LKZ  -  LGC2 

LKXAxx  -  LELAXX 

RKX  -  RGC1  (in  subroutine  URPI) 

RKZ  -  RGC2  (in  subroutine  URPI) 

RKX  -  REL  (in  subroutine  CGTKX) 

* 

(See  Appendix  C  for  changes  for  CGT/PI  formulations  2,3,4.) 

A. 3  Derivation  Showing  that  &R'  *  Kc 

In  the  simple  proof  we  know  that  the  cost  to  be 
minimized  in  the  case  of  both  K's  is  given  by  (?ef  15) 

*TM  ■  Jmin  '  Jmin’  *  (A*29) 


and  since  the  states,  the  s,  are  the  same  on  both  sides  of 


Equation  (A-29) ,  it  follows  directly  that 
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(A-30) 


It  can  also  be  shown  rigorously  that 


V  -  ILc  a  1  +  £TKc*  -  ^BdTKcf  +  STlV  (A-31 ) 


Given  Equation  (III-18a)  which  is  the  K  portion  of 

c 

Equation  (A-31) ,  lets  show  that  K  '  is  equal  to  the  same 

"*R 

relationship.  Starting  with  our  equation  in  question. 
Equation  (II 1—4 9 ) ,  utilize  Equation  (III-51)  to  get 
(dropping  the  delta  subscripts) 


Kr'  =  X'  +  i,TKR'i'  -  £,TSr,BSc*' 


(A-32) 


Substituting  Equation  (III-48b)  for  X',  Equation  (IIl-47b) 

* 

for  t',  Equation  (III-52)  for  Q  multiplying  out 
the  resultant  equation  and  canceling  like  terms,  we  have 


V  *  tX  +  £TKr'I  -  iTKR'B£c*l  -  [gu“1{a\R,t  +  aT) 


—1  T  * 

-  SU  a  5r'bgc  ] 


(A-33 ) 


Noting  that  the  portion  of  Equation  (a-33)  in  braces  {}  is 


equal  to 


{  }  -  [fl  +  BTKR'B]gc*  -  UQC*  +  aTKR'SGc*  (A-: 
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and  making  this  substitution,  canceling  the  resultant  like 
terms,  we  have 

V  *  *  +  iVl  -  *TJSr’BS0*  -  s&c* 

fp  m  ip 

*  X  +  i  KR't  "  "  S  1  Sc 

which  is  the  result  we  were  seeking.  So  K  and  K  ' 
satisfy  the  same  terminal  condition  and  the  same  difference 
equation,  so  they  are  equal  for  all  time. 


(A-35a) 

(A-35b) 
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Appendix  B 


CGTPIQ  User's  Guide 


B.l  Introduction 

The  primary  objective  of  this  thesis  effort  is  to 
create  a  computer  program  with  which  to  design  CGT/PI/KF 
controllers  with  the  PI  controller  based  on  the  integral  of 
the  regulation  error.  This  user's  guide  discusses  the 
program  which  has  been  developed — hereafter  to  be  referred 
to  as  CGTPIQ — as  an  existing  program  (as  it  executes  under 
CYBER  INTERCOM)  and  with  the  intention  of  providing 
information  appropriate  to  successful  execution  when  applied 
to  the  user's  design  problem.  It  discusses  program 
operation  from  the  input/output  perspective:  the  specific 
input  and  output  of  each  design/evaluation  path  and  the 
terminology  employed  in  each  input/output  item.  It  also 
discusses  what  the  user  must  do  both  before  and  immediately 
following  program  execution.  The  discussion  presented  in 
this  guide  is  based  on  the  program  developed  using  CGT/PI 
formulation  1  (see  Section  3.3.2).  Appendix  C  gives  the 
required  code  changes  for  the  other  formulations,  but  they 
are  not  discussed  here.  The  changes  to  program  execution  by 
each  CGT/PI  formulation  is  either  very  minor  or 
non-existent.  (Note:  the  reader  will  see  duplicated 
material  from  other  chapters.  This  is  done  so  that  this 
User's  Guide  will  be  complete  by  itself.) 

While  the  specific  test  application  for  the  program 
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create  a  computer  program  with  which  to  design  CGT/PI/KF 
controllers  with  the  PI  controller  based  on  the  integral  of 
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to  as  CGTPIQ — as  an  existing  program  (as  it  executes  under 
CYBER  INTERCOM)  and  with  the  intention  of  providing 
information  appropriate  to  successful  execution  when  applied 
to  the  user's  design  problem.  It  discusses  program 
operation  from  the  input/output  perspective:  the  specific 
input  and  output  of  each  design/evaluation  path  and  the 
terminology  employed  in  each  input/output  item.  It  also 
discusses  what  the  user  must  do  both  before  and  immediately 
following  program  execution.  The  discussion  presented  in 
this  guide  is  based  on  the  program  developed  using  CGT/PI 
formulation  1  (see  Section  3.3.2).  Appendix  C  gives  the 
required  code  changes  for  the  other  formulations,  but  they 
are  not  discussed  here.  The  changes  to  program  execution  by 
each  CGT/PI  formulation  is  either  very  minor  or 
non-existent.  (Note:  the  reader  will  see  duplicated 
material  from  other  chapters.  This  is  done  so  that  this 
User '8  Guide  will  be  complete  by  itself.) 

While  the  specific  test  application  for  the  program 
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in  the  context  of  this  thesis  has  been  related  to  aircraft 
control  design,  CGTPIQ  is  written  to  be  applicable  to  a  wide 
variety  of  control  design  problems.  It  has  the  following 
attributes: 

1.  CGTPIQ  executes  interactively 

2.  The  program  utilizes  efficient  array  allocation 

a.  Initial  memory  allocation  easily  set 

b.  Dynamic  array  allocation  within  total  memory 
allocated 

3.  Various  modes  of  entry  are  possible  for  the 
dynamics  models 

4.  Design  paths  are  automatically  followed,  with 
user  prompts  at  necessary  decision  points 

5.  Requests  for  input  include  informative  prompts 

6.  Copious  program  output  is  provided 

a.  Output  most  relevant  to  design  decisions  are 
provided  directly  to  the  terminal 

b.  Additional  detailed  output  is  provided  to  a 
separate  output  file 

7.  Information  relevant  to  design  iteration  is 
preserved 

8.  Information  needed  for  evaluation  by  computer 
program  "PFEVAL”  is  preserved  (Ref  21) 

9.  Error  checking  is  performed,  and  messages  given 
as  appropriate 

CGTPIQ  employs  computational  routines  available  in  a 
library  of  matrix  computer  routines  described  in  Ref  (12). 
Exclusive  of  the  library  routines,  the  program  has  a  length 


of  more  than  2900  lines  of  source  code.  The  programming 
language  employed  is  ANSI  Standard  FORTRAN  IV.  Although  the 
resulting  source  code  is  highly  portable,  local  memory 
utilization  limits  for  interactive  execution  may  impose 
constraints.  In  use  on  a  Control  Data  Corporation  CYBER 
machine,  the  necessary  load  size  was  achievable  with  no 
impact  on  the  source  code.  Thus  the  existing  source  code  is 
in  a  pure  form  for  whatever  system.  The  final  program  size 
is  much  greater  than  the  normal  65000  octal  word  limitation 
of  the  CYBER  interactive  system.  Thus,  in  order  to  achieve 
interactive  operation  and  provide  sufficient  free  memory  for 
array  allocation  so  that  problems  of  large  and  variable 
dimensions  can  be  treated,  a  CYBER  Loader  option  referred  to 
as  "Segmentation"  (Ref  7)  must  be  used.  (Note:  even  with 
segmentation  the  program  requires  nearly  67000  octal  words.) 
The  required  segmentation  code  will  be  presented  later  in 
this  guide. 

CGTPIQ  was  written  specifically  to  run 
interactively.  Requests  for  input,  while  intentionally 
brief,  tell  the  user  what  is  expected  of  him~what,  how 
many,  and  in  what  units,  as  appropriate.  Output  of 
information,  relevant  to  design  decisions,  to  the  terminal 
is  compact  and  automatically  provided.  Also,  the  user  can 
determine  the  amount  and  category  of  output  to  the  terminal 
in  some  cases,  and  according  to  need. 

An  objective  of  this  thesis  effort  was  for  CGTPIQ  to 
be  similar  to  the  program  CGTPIF  by  Floyd  (Ref  9),  as 
modified  by  Moseley  (Ref  21) ,  and  every  effort  was  made  for 
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this  to  be  the  case.  For  this  reason  the  two  program's  are 
almost  identical  in  operation.  Appendix  A,  which  discussed 
the  actual  programming  text  changes,  assumed  that  the  user 
must  have  copies  of  Floyd's  and  Moseley's  Theses  to  effect 
any  change  to  the  program.  Appendix  A  was  not  discussed  in 
detail  since  most  users  will  not  need  to  change  the  program. 
On  the  other  hand,  a  complete  user's  guide  is  necessary  for 
the  user  to  be  able  to  use  the  program;  therefore,  this 
user's  guide  is  taken  entirely  from  the  theses  by  Floyd  and 
Moseley  (Refs  9  and  21) ,  with  necesary  changes  to  reflect 
the  changes  made  in  the  program,  so  that  the  user  will  not 
need  copies  of  the  other  two  theses  to  use  this  program. 

B.2  Program  Operating  principles 

and  organization 

CGTPIQ  has  three  design  paths:  (1)  design  of  a  PI 
controller  (using  explicit  and/or  implicit  quadratic 
weights);  (2)  design  of  either  an  open- loop  CGT  or 
closed- loop  CGT/PI  controller,  and  (3)  design  of  a  Kalman 
filter.  Corresponding  to  the  first  two  design  options  is  a 
controller  evaluation  set  of  routines,  and  corresponding  to 
the  third  design  option  is  a  set  of  routines  for  filter 
evaluation.  The  evaluation  routines  perform  the 
computations  discussed  in  Appendix  D. 

A  general  flowchart  of  CGTPIQ  is  given  in  Figure 
B-l ,  showing  the  main  execution  paths  and  design  entries. 

The  controller  sample  period  is  entered,  the  design  model  is 
established,  and  then  the  desired  design  path  can  be 

B-4 


.  '  .VJVV  ^ .  ^  ^ 


.V 


* 


followed.  The  elementary  design  path  choice  is  between 
controller  and  filter  designs.  The  CGT  or  CGT/PI,  and  the 
PI  controller  (for  explicit  and/or  implicit  quadratic 
weights)  design  paths  are  then  options  within  the  controller 
design.  If  the  PI  controller  design  is  pursued  prior  to  the 
CGT  design  path,  the  CGT  design  will  automatically  be  of  the 
CGT/PI  controller.  If  the  PI  is  not  already  determined 
during  the  current  execution  of  the  program,  then  the 
designer  may  elect  ot  design  either  a  CGT  or  a  CGT/PI 
controller.  However,  the  CGT  controller  design  is  not 
pursued  if  the  open-loop  design  model  is  unstable.  The 
controller  design  path  is  followed  automatically  by  the 
appropriate  controller  evaluation  path.  Similarly,  the 
filter  design  path  leads  automatically  to  the  filter 
evaluation.  When  the  evaluation  is  complete  the  designer  is 
given  the  opportunity  to  loop  on  the  design  path,  choose  a 
different  design  path,  or  terminate  program  execution.  More 
detailed  flowcharts  and  functional  diagrams  are  given  later. 
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Each  of  the  dynamics  models  entered  into  CGTPIQ  is 
represented  by  a  set  of  continuous- time  state  differential 
equations.  The  names  used  in  the  equations  to  follow  are 
exactly  those  used  by  CGTPIQ  in  reference  to  these  same 
dimensions  and  arrays  in  its  Input/Output  (I/O).  Note  that 
here  each  name  is  a  single  character,  possibly  subscripted, 
while  in  its  I/O,  CGTPIQ  incorporates  subscripts  into  the 
name  (e.g.,  becomes  "AT") .  Constraints  on  the  models 
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that  are  presented  below  are  tested  by  CGTPIQ  and,  if  not 
satisfied,  a  message  is  written  to  the  user  terminal  and 
execution  is  aborted.  These  will  be  discussed  later. 


B.3.1  Design  Model 

The  design  model  is  given  by 

S(t)  -  A*(t)  +  Bli(t)  +  fixIld(t)  +  £w(t)  (B-la) 

aa(t)  “  &nQd(t)  +  Gn*d(t)  (B-lb) 

l(t)  »  Cx ( t)  +  Byu(t)  +  Byad(t)  (B-lc) 

a(ti)  -  ax(ti)  +  anQd(ti)  +  i(t.)  (B-id) 

and  and  2  are  independent  zero-mean  noises  with 

statistics 

E{w(t)wT(t+T) }  «  (B-2a) 

E(sfd(t)wdT(t+tr) }  -  an<(f)  (B-2b) 

E{2(ti)vT(tj)}  •  (B-2c) 

In  these  equations,  j,  u,  r^,  £,  and  z  are  the  system 


state,  input,  disturbance  state,  output,  and  measurement 
vectors,  respectively,  in  input  prompts,  CGTPIQ  refers  to 
the  diagonal  elements  of  the  noise  covariance  matrices  as 

Q:  "state  noise  strengths"  (B-3a) 

Qn* "disturbance  noise  strengths"  (B-3b) 

B:  "measurement  noise  strengths"  (B-3c) 

Note  the  Q,  Qn,  and  R  are  all  assumed  to  be  diagonal 
matrices.  The  dimensions  of  the  model  are 
n  *  number  of  system  states 
r  ■  number  of  system  inputs 
p  *  number  of  system  outputs 
m  *  number  of  system  measurements 


d  *  number  of  disturbance  states 
w  a  number  of  independent  system  noises 

number  of  independent  disturbance  noises  (B-4) 
and  the  dimensions  of  the  matrices  of  the  model  are 
A  :  n-by-n 

B  :  n-by-r 

n-by-d 
S  :  n-by-w 

£  s  w-by-w 

£  :  p-by-n 

Dy s  p-by-r 

Ey :  p-by-d 

H  :  m-by-n 

Hn:  m-by-d 

R  :  m-by-m 

&n:  d-by-d 

Qns  d-by-wD 

Qn:  wD-by-wD  <B-5> 

CGTPIQ  requires  that  the  numbers  of  design  systems 
inputs  and  outputs  be  equal:  r»p.  Also,  the  number  of 
system  states  may  not  be  less  than  the  number  of  disturbance 
states,  due  to  the  computational  setup  used  for  the  CGT 
solution.  The  dimensions  n,  r,  and  p  must  be  non-zero;  any 
of  the  other  dimensions  may  be  zero.  If  m  is  zero  or  if  w 
and  are  both  zero,  the  Kalman  filter  design  path 
cannot  be  pursued.  Matrices  having  either  dimension  zero, 
do  not  exist  and  are  not  entered. 


B.3.2  Truth  Model 

The  truth  model  is  specified  by 


xt(t)  *  Afcxfc(t)  +  Bfcut(t)  +  Stwt(t) 

(B-6a 

zt(t)  -  Htxt(t.)  +  Xt(t.) 

(B-6b 

&’(t)  -  Ijj^tt) 

(B-6c 

— d  ^  *  -NT^t^ 

(B-6d 

and  wt  and  v  are  assumed  to  be  independent  zero 
mean  noises  with 

E{wfc  (t)wtT(t+f)  }  *  Qt/(C)  (B-7a 

E{vt(ti)ZtT<tj)>  *  Mij  (B’7b 

where  Equations  (B-6c)  and  (B-6d)  relate  the  system  and 
disturbance  states  of  the  design  model  to  the  system  states 
of  the  truth  model.  Note  that  Qt  and  Rfc  are  both 
assumed  to  be  diagonal  matrices.  In  these  equations, 
xfc,  u^  and  z,t  are  the  truth  model  system  state, 
input,  and  measurement  vectors,  respectively.  The  vectors 
x'  and  are  as  defined  for  the  design  model. 

The  dimensions  of  the  truth  model  are 

nT  *  "number  of  system  states" 

rT  *  "number  of  system  inputs" 

mT  *  "number  of  system  measurements" 

w?  *  "number  of  independent  noises  driving  system 

dynamics"  (B-8 

and  the  dimensions  of  the  matrices  of  the  model  are 
At:  nT-by-nT 

-t!  nT“by“rT 

St*  nT“by-wT 

Q.s  w  -by-wm 


e w&rrwrzm 


b*u  1  y  v.  rv*,rj-  .ip  TFra.-#  ’/v  ->  w  v  w  v  v  -,*  v  -»-  -.-  .-  „•  ^ 


E3 


0 


St«  mfp-by-nT 

-t!  mT“by_raT 
Idt*  n-by-nT 

1NT:  d-by-nT 
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CGTPIQ  requires  that  the  numbers  of  inputs  and  of 
measurements  for  the  truth  and  design  model  be  the  same: 

and  ra^«m.  If  the  number  of  driving  noises 
(wT)  is  zero,  evaluation  of  a  Kalman  filter  design  is 
not  pursued  (since  a  covariance  analysis  with  no  truth  model 
driving  noise  would  not  be  very  informative) .  Matrices 
having  either  dimension  zero,  do  not  exist  and  are  not 
entered. 


B.3.3  Command  Model 

The  command  model  is  given  by 
2m(t>  *  +  2„S»(t> 

2mCt)  *  C.im(t>  +  Ballot) 

In  these  equations,  x_,  u  ,  and  y  are  the 

in  -m 

command  model  state,  input,  and  output  vectors, 
respectively. 

The  dimensions  of  the  command  model  are 


(B-lOa) 

(B-lOb) 


nM  “ 

"number 

rM  " 

"number  < 

Pm  " 

"number  < 

and  the  dimensions  of 

-ml 

nM-by-n„ 

V 

nM-by'rM 

^m! 

(B-ll) 
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-fc* 


5m1  PM-by"rM 

CGTPIQ  requires  that  the  number  of  outputs  of  the 
command  and  design  models  are  equal:  PMSP*  Also,  the 
number  of  system  states  of  the  command  model  (nM)  cannot 
be  greater  that  the  number  of  system  states  of  the  design 
model  (n) .  This  constraint  is  due  to  the  setup  for 
computation  of  the  CGT  solution.  (Note:  the  command  model 
for  explicit  and  implicit  model  following  need  not  be  the 
same,  though  they  may  be.) 
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Overall  Model  Dimensions 


Problems  of  the  following  dimension  can  be 
accommodated  by  CGTPIQ 
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NOTE,  other  combinations  of  dimensions,  some  greater 


*a 


« 

—  »► 

3 


3 


than  and  some  less  than  these  specific  dimensions,  will  also 
be  accommodated  due  to  the  method  by  which  arrays  are 
allocated  and  stored.  If  the  user  has  a  problem  that  does 
not  fit  these  size  restraints  he  should  try  the  problem  to 
see  if  it  will  work.  Messages  will  be  printed  if  he  has 
exceeded  total  allocation,  and  in  that  case,  the  basic 
program  code  will  have  to  be  altered  to  proceed. 


m 


B . 4  Entry  of  Dynamics  Models 

Any  of  the  three  dynamics  models  described  above  may 
be  established  in  any  of  three  ways:  (1)  the  dimensions  and 
matrix  elements  may  be  entered  directly  from  the  terminal 
with  input  prompting  from  CGTPIQ;  (2)  the  dimensions  and 
matrix  elements  may  be  entered  from  a  "DATA"  file  on  which 
the  dynamics  model  from  a  previous  run  of  the  program  was 
written  (the  writing  of  such  a  file  entry  for  each  model  is 
a  program  option);  or  (3)  the  dimensions  and  matrix  elements 
may  be  established  by  user  provided  subroutines  as  was  done 
for  some  of  the  airplane  models  used  and  discussed  in 
Floyd's  thesis  (Ref  9).  These  models  are  also  in  CGTPIQ. 

When  entered  from  the  terminal  directly  or  set  by 
subroutines,  only  non-zero  elements  of  the  various  matrices 
need  be  given.  In  many  cases,  this  substantially  simplifies 
establishing  the  matrices  and  reduces  the  probability  of 
erroneous  entries.  Subsequent  design  runs  for  the  same 
problem  can  then  simply  read  the  models  from  the  "DATA"  file 
previously  created. 

Each  request  for  input  from  the  user  includes  a 
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prompt  by  CGTPIQ  of  information  defining  the  input  desired, 
whether  this  input  is  the  dynamics  models  or  any  other 
required  input.  When  an  option  is  offered,  the  prompt 
succinctly  describes  the  option  and  specifies  the 
appropriate  form  of  response  (e.g.,"Y  or  N" ,  signifying  and 
yes  or  no  response.)  When  a  dimension  is  to  be  entered,  the 
dimension  is  identified,  when  a  matrix  is  to  be  entered, 
the  matrix  is  identified,  as  is  its  dimension,  and  the 
appropriate  form  of  input.  Similarly,  all  other  requests 
for  input  identify  the  input  expected  and  the  form  the  entry 
is  to  take.  The  messages  to  the  user  are  brief  and  require 
that  the  user  have  some  understanding  of  what  is  involved  in 
achieving  each  of  the  designs.  The  prompts  are  intended  to 
assist  users  familiar  with  the  elements  of  the  PI,  CGT, 
CGT/PI ,  and  KF  design  methods  and  with  the  terminology  used 
in  this  thesis  to  enter  the  necessary  information  for  such 
designs  into  the  program. 

B.5  Program  Output 

In  the  computations  involved  in  the  various  design 
paths,  a  great  deal  of  information  is  generated.  While  all 
the  information  generated  may  be  relevant  to  the  design,  in 
the  usual  case  only  a  small  fraction  of  the  information  is 
needed  to  pursue  iteration  of  the  design  paths.  Information 
most  relevant  to  achieving  the  various  designs  is  output  to 
the  terminal  either  automatically  or  at  the  user's  option. 
The  same  information,  along  with  all  other  potentially 
useful  information  generated  by  the  program,  is  also  output 
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to  a  "LIST"  file.  After  program  execution  is  complete,  the 
user  may  then  look  through  this  file  at  the  terminal  or  may 
"ROUTE"  it  to  a  line  printer  for  a  complete  listing.  All 
output  is  given  an  identifying  name  or  description  which  is 
consistent  with  the  terminology  of  this  thesis. 

Plots  are  available  as  options  of  the  design 
evaluation  routines.  The  plots  produced  are  of  the  "line 
printer"  type.  For  the  controller,  plots  of  selected 
variables  may  be  output  to  the  terminal,  in  addition  to  the 
full  set  of  plots  output  to  the  "LIST"  file. 

During  program  execution,  user  entries  in  the  design 
iteration  are  preserved.  Thus,  for  each  iteration  only 
those  entries  to  be  changed  need  be  given  as  input,  making 
design  iteration  both  fast  and  easy  in  terms  of  the  simple 
mechanics  of  the  process.  Also,  computations  which  are  not 
modified  by  design  iteration  are  performed  only  once  and  the 
results  are  preserved  for  reuse  within  the  current  run,  as 
needed. 


B . 5. 1  File  Usage:  PLOT,  SAVE,  DATA,  LIST 

In  addition  to  the  I/O  communication  directly  with 
the  user  terminal,  CGTPIQ  employs  four  disk  files  for  I/O 
purposes.  One  of  these  ('PLOT')  is  for  temporary  use  by 
CGTPIQ  only.  The  other  three  files  ('SAVE1,  'DATA',  and 
'LIST')  benefit  the  user  by  providing  continuity  between 
distinct  executions  of  the  program  (SAVE,  DATA)  or  providing 
supplementary  design  output  data  (LIST) . 


CGTPIQ  preserves  information  for  use  in  distinct 


execution  of  the  program  through  use  of  the  SAVE  and  DATA 
files.  During  program  execution,  the  dynamics  models  as 
well  as  the  PI  controller  gains  (if  available)  may  be 
written  to  the  SAVE  file.  Following  execution,  the  user  may 
wish  to  catalog  SAVE  as  a  permanent  file.  In  subsequent 
executions,  CGTPIQ  may  (at  the  user's  option)  read  any  of 
the  dynamics  models  or  PI  gains  from  the  file  named  DATA. 
(Also  the  gains  to  be  used  by  the  program  "PFEVAL"  are  also 
written  to  the  SAVE  file).  Both  files  are  rewound  prior  to 
and  following  program  execution.  Letting  the  abbreviations 
"BE"  and  "AE"  mean  before  and  after  execution,  respectively, 
typical  operations  on  these  files  include: 

1.  Catalog  SAVE  file: 

a.  BE : REQUEST, SAVE, *PF 
AE : CATALOG , SAVE , pf n 

b.  AE: REQUEST, DUM,*PF 
AE : COPYBF , SAVE , DUM 
AE : CATALOG , DUM , pf n 

2.  Attach  DATA  file: 

BE : ATTACH , DATA , pf n 

3.  Reuse  SAVE  file  as  new  DATA  file 

AE: RETURN, DATA 

BE : COPYBF , SAVE , DATA 

None  of  these  operations  are  required;  they  are  simply 
useful  operations  in  the  event  the  user  chooses  to  employ 
the  files  to  streamline  repeated  executions  of  a  given 
design  problem.  Note  that  SAVE  and  DATA  are  local  file 
names  and  that  the  permanent  file  names  are  represented  here 


by  the  abbreviations  "pfn".  Other  operations  (e.g.,  PURGE) 
and  other  combinations  of  operations  are  possible  as  for  any 
files,  and  the  usual  rules  for  these  operations  apply  here 
as  well.  The  essential  points  to  understand  are  that  the 
SAVE  file  is  created  by  CGTPIQ  and  is  an  output  file  only, 
and  that  DATA  is  a  previously  SAVE'd  file  under  a  new  local 
file  name  and  is  an  input  file  only.  During  a  single 
program  execution  the  two  files  are  distinct  and  these  roles 
cannot  be  changed. 

During  program  execution,  extensive  design 
information  is  output  to  the  LIST  file.  After  execution  is 
complete,  the  user  may  wish  to  route  LIST  to  a  line  printer 
for  listing  (or  it  may  be  "PAGED"  at  the  user  terminal) . 

The  file  is  rewound  before  and  after  execution.  To  send 
LIST  to  a  line  printer,  the  following  command  is  used  after 
execution: 

ROUTE , LIST , DC*PR , TID- nn , ST-CSB , FID»abc 


in  which  "nn"  is  the  identification  number  of  the  terminal 
to  which  the  file  is  to  be  sent  (for  AFIT  ,nn=AF) ,  and  "abc1 
is  any  three  character  output  banner  for  the  listing. 

The  PLOT  file  is  used  internally  by  CGTPIQ  for 
temporary  storage  of  the  variables  generated  by  time 
response  evaluations  of  the  controller  or  filter.  If 
desired,  it  may  be  eliminated  following  execution  using  the 


command : 


RETURN, PLOT 
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B.6  Error  Checking 

A  common  problem  encountered  in  executing  computer 
programs  with  variable  dimension  array  storage  is  the 
unintentional  (and  often  unknown)  over-running  of  the 
allocated  storage  area.  When  this  happens,  the  program  may 
fail  (due  to  the  over-writing  of  program  code,  for  example) 
or,  even  worse,  the  program  may  appear  to  run  properly  but 
provide  erroreous  results.  To  avoid  these  difficulties, 
before  using  each  of  the  Common  arrays,  CGTPIQ  computes  the 
allocation  needed  for  the  arrays  it  will  generate  and 
compares  it  with  the  number  of  words  of  memory  actually 
allocated.  If  more  memory  is  needed  than  has  been  provided, 
a  message  is  written  indicating  the  problem,  the  Common  in 
question,  and  the  minimum  allocation  needed.  Execution  is 
then  aborted. 

Error  checks  for  array  entry  from  the  terminal  are 
also  performed.  Not  only  are  the  array  dimensions 
identified  in  prompts  requesting  entry  of  arrays,  but  each 
entry  is  checked  to  verify  that  it  is  within  the  row,  column 
bounds  for  the  array.  If  not  within  bounds,  the  entry  is 
not  accepted  and  a  message  identifying  the  problem  is  given. 
Also,  for  matrices  requiring  special  properties  (e.g., 
positive  semi-definiteness),  entries  which  clearly  violate 
these  requirements  (e.g.,  negative  diagonal  elements)  are 
not  accepted  and  a  message  is  written  to  the  terminal. 

Various  other  error  checks  are  performed  for  each 


input  entered  from  the  terminal.  These  checks  ensure  that 
no  obviously  invalid  entries  are  accepted  (e.g.. 


non-positive  controller  sample  time) ,  and  no  storage  out  of 
array  bounds  occurs.  Obviously,  it  is  not  possible  to  guard 
against  valid  yet  erroneous  entries,  but  in  most  cases  the 
program  provides  opportunities  to  correct  mistaken  entries 
made  and  discovered  by  the  user.  Additional  tests  are 
performed  to  ensure  dimensional  consistency  of  the  dynamic 
models.  These  dimensions  were  discussed  previously.  For 
example,  CGTPIQ  checks  that  the  numbers  of  inputs  and 
outputs  defined  for  the  design  model  are  equal,  as  well  as 
checking  each  of  the  other  dimensional  conditions  as  each 
model  is  established.  If  the  condition  is  not  met,  a 
message  identifying  the  problem  is  written  and  the  program 
execution  is  aborted. 

B . 7  Preparation  Prior  to  Program  Execution 

Preparation  for  use  of  the  program  consists 
primarily  in  determining  the  dimensions  of  the  models  to  be 
employed  and  the  specific  coefficients  of  the  matrices 
comprising  those  models.  It  is  appropriate  for  the  PI 
design  that  an  initial  set  of  quadratic  weights  be 
established  also,  in  order  to  begin  the  design  iteration 
process. 

Assuming  that  the  user  understands  the  nature  and 
requirements  of  the  various  design  elements,  and  is  familiar 
with  terminology  related  to  such  designs,  the  actual 
execution  of  the  program  involves  straightforward  response 
to  input  prompts.  The  specific  meaning  of  all  program 
prompts  employed  will  be  discussed  later.  Information  most 


useful  to  the  design  iterations  is  available  directly  as 
output  to  the  terminal,  while  additional  information  is 
provided  in  the  separate  output  'LIST1  file.  The 
terminology  employed  in  the  output  is  defined  later. 

B.7.1  Determine  Dynamics  Models 

CGTPIQ  employs  three  dynamics  models  as  discussed 
previously.  It  is  necessary  that  the  user  determine  the 
dimensions  and  parameters  of  these  models  prior  to  execution 
of  the  program.  The  specific  models  needed  to  execute  the 
design  paths  of  interest  need  be  known.  At  a  minimum,  the 
design  model  must  be  known  in  order  to  execute  any  of  the 
designs.  The  truth  model  is  required  for  evaluation  of  the 
Kalman  filter  (to  perform  a  covariance  analysis)  and  is 
optional  for  evaluation  of  the  PI  controller  or  CGT  and 
CGT/PI  controllers.  The  command  model  must  be  known  in 
order  to  effect  either  CGT  or  CGT/PI  designs.  The  dynamics 
models  are  entered  into  the  program  during  execution  as 
needed  and  under  input  prompting  provided  by  CGTPIQ. 

B.7.2  Define  Objectives  and  Specifications 

Before  embarking  upon  design  of  the  controller,  the 
designer  should  define:  (1)  the  objectives  which  are  to  be 
sought,  and  (2)  appropriate  specifications  and  constraints 
to  apply  to  the  controller.  These  may  be  rather  loosely 
defined  initially,  then  become  more  specific  and  firm  as  the 
design  progresses.  Objectives  will  vary  with  the  problem 
under  consideration,  but  might  be  exemplified  by  formulation 


of  a  desired  controlled  output  response  behavior. 
Specifications  and  constraints  derive  from  the  problem 
application  and  from  the  objectives  for  the  design.  Typical 
considerations  include  time-delay,  overshoot,  and  settling 
time  of  the  response,  and  input  magnitudes  and  rate  limits. 


B.7.3  Determine  Appropriate  Initial  Quadratic  Weights 

Execution  of  the  PI  controller  design  entails  entry 

of  quadratic  weights  for  the  optimal  dost  function.  Such 

weighting  matrices  are  required  for  the  outputs,  the  input 

magnitudes,  and  the  integral  of  the  regulation  error  (also 

implicit  weights  to  be  discussed  later).  For  these,  only 

diagonal  elements  are  required  as  input,  since  CGTPIQ 

assumes  them  to  be  diagonal  matrices.  However,  after  CGTPIQ 

computes  the  resulting  augmented  state  and  integral  of  the 

regulation  error  weighting  matrix  (Equation  (III-36c) ) ,  the 

user  may  modify  any  element  of  it  to  achieve  design  goals. 

Although  final  selection  of  appropriate  quadratic 

weighting  values  to  achieve  design  requirements  is  achieved 

in  an  iterative  ( tr ial-and-error ,  hopefully  with  insight) 

fashion,  it  is  possible  to  make  initial  choices  which  are 

plausible.  A  common  method  for  determining  initial 

quadratic  weights  involves  inverse  square  weighting  of 

maximum  deviations  of  outputs  and  inputs  to  achieve 

regulation  for  an  assumed  perturbation  of  the  system  (Refs 

15  and  18:10-11).  For  example,  the  diagonal  output 

weighting  matrix  element  would  be 

2 

»  1. /(maximum  allowable  j^)  . 


Beginning  with  the  initial  set  of  quadratic  weights, 
the  FI  design  path  is  executed  repeatedly  with  changes  in 
the  choice  of  weighting  elements  until  the  design  is 
satisfactory.  CGTPIQ  provides  information  during  execution 
which  allows  the  design  to  be  evaluated  and  iteration  of  the 
design  to  be  pursued  effectively. 

For  open-loop  CGT  designs  and  Kalman  filter  designs, 
preparation  consists  of  defining  the  various  dynamics 
models.  The  open-loop  CGT  design  depends  only  on  the  design 
and  command  models.  The  initial  execution  of  the  Kalman 
filter  path  depends  only  on  the  design  model  (and  truth 
model  for  evaluation) .  Further  refinements  to  either  design 
are  achieved  through  modifications  of  the  appropriate 
dynamics  model  (command  or  design) . 

B.8  CGTPIQ  Execution 

B.8.1  Introduction 

An  important  feature  of  CGTPIQ  is  that  it  follows 
appropriate  paths  through  execution  automatically,  prompting 
the  user  for  input  as  necessary.  The  basic  design  paths  are 
selected  by  the  user  under  prompting,  but  within  a  given 
path,  only  information  needed  to  execute  the  specific  design 
and  evaluation  is  requested  by  the  program.  The  user  thus 
does  not  need  any  predetermined  sequence  of  command  entries 
to  the  program,  nor  are  the  commands  coded  in  any  way. 

Figure  B-l  gave  a  general  flowchart  of  CGTPIQ.  Each 
of  the  decision  blocks  (diamond  shaped)  represent  a  prompted 
request  for  input  to  choose  the  design  to  be  pursued.  Each 


rectangular  block  with  an  alphabetic  character  ("A"  through 
"H")  in  the  lower  right  corner  represents  a  computational 
element  of  CGTPIQ  and  is  discussed  individually  in  the 
following  subsections.  The  subsections  which  follow  discuss 
the  I/O  of  each  computational  element.  In  identifying  items 
of  I/O,  reference  will  sometimes  be  made  to  array  names  and 
equations  which  are  specified  elsewhere  in  this  thesis 
(equation  references  will  be  in  parentheses  following  the 
array  name) .  All  prompts  for  input  define  the  input  that  is 
being  requested  and  the  manner  in  which  the  entry  should  be 
given.  Since  the  actual  prompts  are  themselves 
understandable,  they  will  not  be  quoted  here.  Instead, 
flowcharts  will  be  used  to  show  where  prompts  occur  and  how 
execution  depends  on  user  entries.  Blocks  involving  I/O 
will  be  identified  by  function:  an  "I"  block  will  signify 
prompted  input  from  the  terminal;  an  "OT"  or  "0L"  block  will 
signify  output  to  the  user  terminal  or  LIST  file, 
respectively.  All  output  to  LIST  is  separated  and 
identified  according  to  the  computational  element  which 
generated  it. 

B.8.2  Types  of  Entries 

Required  inputs  may  entail  entry  of  a  decision  logic 
value,  a  single  numerical  or  character  value,  or  multiple 
numerical  values  for  arrays  or  vectors.  In  all  cases, 

CGTPIQ  prompts  the  user  with  messages  identifying  the  nature 
of  the  input  requested  and  each  prompt  ends  with  the 
character  ">". 


All  requests  for  decisions  affecting  execution  are 
framed  as  questions  requiring  a  YES  ("Y")  or  NO  ("N") 
response.  The  user  entry  is  read  as  character  input. 
Execution  proceeds  according  to  a  default  "YES”  assumption: 
all  decision  tests  assume  that  if  the  answer  is  not  "NO", 
then  it  is  "YES". 

Requests  requiring  single  entry  responses  always 
specify  the  variable  requested.  If  there  are  constraints  on 
acceptable  input  they  are  indicated  in  the  prompt  and 
adherence  is  tested  in  the  program  after  entry.  If  the 
entry  is  not  "valid",  a  message  is  written  to  the  terminal 
and  the  prompt  is  repeated. 

All  requests  for  entry  of  vector  or  array  elements 
specify  the  name  of  the  array  in  question  and  its  actual 
dimensions.  Entries  for  vector  elements  include  an  integer 
specifying  the  index  of  the  element,  and  a  real  specifying 
its  value.  For  most  arrays,  all  elements  may  be  given 
values,  while  for  some  square  matrices,  only  diagonal 
elements  may  be  set  (the  prompt  format  will  distinguish 
between  the  two).  In  the  usual  case,  elements  are  entered 
into  arrays  by  specifying  two  integers  for  the  [row, column] 
address  and  a  real  for  the  value  of  that  element.  In  cases 
in  which  only  diagonal  elements  can  be  specified,  entry  is 
the  same  as  for  vectors,  with  the  matrix  diagonal  considered 
a  vector.  As  many  entries  as  desired  may  be  made  and  any 
entry  can  be  repeated  (e.g.,  to  correct  previous  erroneous 
entries).  Entry  is  terminated  by  specifying  a  row  index  of 
zero.  Each  entry  is  tested  to  verify  that  it  lies  within 


the  [row, column]  bounds  of  the  array  (vector).  If  an  index 
is  not  "valid",  a  message  is  written  to  the  terminal 
indicating  the  error  and  the  initial  prompt  with  the  array 
dimensions  is  given  again  (previous  valid  entries  are  not 
affected,  only  the  specific  invalid  entry  is  rejected).  If 
an  entry  is  valid,  the  element  value  is  set  and  the  next 
entry  is  awaited  without  additional  prompting.  For  example, 
if  it  is  desired  to  set  a  square  matrix  of  dimension  three 
to  an  identity  matrix,  then  according  to  whether  the 
specific  matrix  is  to  be  entered  in  [row, column]  or  diagonal 
form,  entries  would  be  as  follows: 

1.  For  [row, column]  entry  format 

111.  (enter) 

221.  (enter) 

331.  (enter) 

0/ 

2.  For  diagonal  element  entry  format 

1  1.  (enter) 

2  1.  (enter) 

3  1.  (enter) 

0/ 

Items  of  information  may  be  separated  by  one  or  more  blanks 
or  by  a  comma.  These  entries  set  specific  elements  of  the 
matrix  to  non-zero  values  (the  matrix  was  initialized 
automatically  with  all  elements  zeroed) .  The  following 
sections  will  now  discuss  the  individual  boxes  denoted  with 
a  letter  in  Figure  B-l. 
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B.8.3  Establishing  Dynamics  Models  ("A") 

All  three  dynamics  models  (design,  truth,  and 
command)  are  entered  under  the  control  of  a  single  set  of 
routines.  The  options  for  entry  and  the  type  of  I/O 
involved  for  each  is  of  identical  format,  but  prompts  and 
output  employ  terminology  specific  to  each  model  to  identify 
items  of  I/O. 

Figures  B-2a,b,c  give  flowcharts  of  the  I/O  involved 
in  entry  of  the  models.  Note  that  any  of  the  dynamics 
models  may  be  entered  in  any  of  the  following  ways: 

1.  The  dimensions  and  array  elements  may  be  read 
from  the  DATA  file. 

2.  The  dimensions  and  array  elements  may  be  entered 
from  the  user  termnal  as  prompted  by  CGTPIQ. 

3.  The  dimensions  and  array  elements  may  be 
determined  by  user-provided  subroutines. 

These  modes  of  entry  are  offered  by  CGTPIQ  in  the  order 
above,  with  option  3  assumed  selected  if  options  1  and  2  are 
declined.  If  option  1  is  selected,  the  reading  of  the  model 
is  automatically  performed.  If  the  model  is  found  not  to 
exist  in  the  DATA  file,  the  other  options  are  offered.  For 
option  3,  if  the  subroutines  needed  to  define  the  model  are 
not  loaded,  option  1  and  2  are  offered  again.  This  logic  is 
illustrated  in  Figure  B-2a. 

Prior  to  entry  of  the  model  matrices,  all  matrix 
elements  are  initialized  to  zero.  Using  option  1,  all  array 
elements  are  then  read  automatically  from  the  DATA  file. 

For  options  2  and  3  only  the  non-zero  array  elements  must  be 


B-25 


Fig.  B-2b .  Enter  Dynamics  Model  £rom  Terminal 


established 


Figure  B-2b  illustrates  model  definition  under 
option  2.  Entry  of  the  diminsions  and  arrays  is  according 
to  prompts  by  CGTPIQ.  The  dimensions  are  requested  first  by 
the  names  and  in  the  order  of  Equation  (B-4),  (B-8),  or 
(B— 11) ,  as  appropriate.  The  arrays  are  then  requested,  also 
by  name  and  in  the  order  of  Equation  (B-5),  (B-9) ,  or 
(B-12),  as  appropriate.  An  array  is  not  requested  if  its 
dimension  is  zero.  Each  prompt  includes  the  actual 
dimensions  of  the  array  according  to  the  model  dimensions 
previously  entered.  Elements  of  arrays  are  entered  by 
address,  and  value  by  giving  the  [row, column]  address  and 
element  value  as  a  three  item  input.  Entry  of  a  zero  row 
address  terminates  entry  of  the  array. 

For  option  3,  each  model  requires  two  user-provided 
routines  of  prescribed  names,  argument  lists,  and 
characteristics.  These  must  be  compiled  with  the  main 
routine  of  CGTPIQ  and  a  segmented  executable  object  file 
created.  For  each  model  defined  by  subroutines,  one 
subroutine  must  establish  the  dimensions  of  the  model,  and 
another  must  set  the  values  for  all  matrices  of  that  model. 
Each  routine  must  have  the  appropriate  name  and  argument 
list.  All  model  arrays  appearing  in  the  argument  lists  must 
be  allocated  in  full  manner:  the  array  dimensions  specified 
by  "Dimension”  statements  within  the  routines  must  be 
exactly  those  implied  by  the  routine  specifying  model 
dimensionalities  and  the  array  sizing  given  by  Equations 
(B-5),  (B-9),  and  (B-12).  For  example,  if  the  number  of 


design  model  states  (n)  is  established  as  10,  then  according 
to  Equation  (B-5)  the  system  matrix  must  be  explicitly 
dimensioned  A(10,10)  in  the  subroutine  which  sets  array 
values  for  the  design  model.  All  of  these  arrays  are 
initialized  to  zero  before  the  array  setting  routines  are 
called,  so  it  is  necessary  only  to  set  non-zero  array 
elements  within  the  subroutines.  Any  arrays  of  dimension 
one  in  both  row  and  column  are  actually  scalars  and  need  not 
be  included  in  a  Dimension  statement.  Any  arrays  with  row 
or  column  dimension  of  zero  are  in  fact  nonexistent  arrays 
and  must  not  be  included  in  Dimension  statements,  although 
they  still  must  be  included  in  the  subroutine's  argument 
list  (since  calls  to  these  routines  from  within  CGTPIQ 
assume  full  argument  lists). 

After  a  model  is  defined  using  any  of  the  three 
entry  options,  the  user  may  list  any  matrix  and  modify  any 
array  elements,  again  under  prompting  by  CGTPIQ.  If  a 
modification/ list  is  desired,  the  names  of  the  model's 
matrices  are  listed  at  the  terminal  and  the  user  specifies 
the  array  of  interest  by  name.  Elements  are  entered  by 
address  and  value  as  described  previously.  Figure  B-2c 
illustrates  the  I/O  involved  in  modifying/listing  model 
arrays. 

When  the  model  has  been  defined  to  the  user's 
satisfaction,  it  may  be  written  to  the  SAVE  file  by  CGTPIQ 
if  the  user  chooses.  In  the  course  of  design  iteration,  the 
truth  and  command  models  may  be  redefined  if  desired,  but 
only  a  single  copy  of  any  model  may  be  written  to  the  SAVE 


file  during  a  given  execution  of  the  program  (CGTPIQ  will 
not  offer  additional  opportunities  after  a  given  model  has 
been  SAVE'd). 

For  each  model,  the  discrete-time  representation  is 
computed  for  the  controller  sample  period  specified.  Later 
computations  do  not  depend  on  the  continuous- time  dynamics 
models,  so  the  arrays  defining  them  are  not  retained. 

(Note:  To  consider  effects  of  different  sample  periods,  the 
program  will  require  re-execution  with  re-entry  of  the 
models.) 

Arrays  defining  both  the  continuous- time  and 
discrete-time  models  are  given  in  output  to  the  LIST  file. 
The  specific  output  items,  their  names,  and  the  reference 
equations  are  listed  below  for  each  model 


Design  Model 

Continuous- time  model  matrices  as  listed  in  Equation 
(B— 5 ) ,  plus  discretized  model  matrices  as: 


PHI:  * 


(IV-5) 


BD: 

Bd 

(IV-5) 

QD: 

-ad 

(IV-6c) 

HA: 

3a 

(IV-ld) 

EXD: 

Sxd 

(IV-7a) 

PHN: 

in 

(IV-7b) 

Command  Model 

Continuous- time  model  matrices  as  listed  in  Equation 
(B-12) ,  plus  discretized  model  matrices  as: 


B-30 


PHM: 

5m 

(IV-17) 

BOM: 

-rad 

(IV-17) 

CM: 

£m 

(IV-18) 

DM: 

(IV-18) 

Truth  Model 

Continuous-time  model  matrices  as  listed  in  Equation 
(B-9) ,  plus  discretized  model  matrices  as: 

PHT:  ft  (IV-12) 

BDT:  8td  (IV-12) 

QDT:  Qtd  (IV— 13c) ) 


In  addition,  the  eigenvalues  of  the  system  matrices 
of  each  model  (&r  &m,  are  computed  and  output 

both  to  the  user  terminal  and  the  LIST  file.  The  system 
model  is  identified  by  type  (design,  command,  truth). 
Eigenvalues  of  the  corresponding  discretized  system  matrices 
are  not  computed. 

B.8.4  Controller  Setup  (”B") 

The  "controller  setup”  routines  perform  computations 
needed  for  the  controller  designs.  No  input  is  required  of 
the  user  and  the  output  is  to  the  LIST  file  only.  The 
output  is  the  matrix  gx 

PI:  g  (11-18) 


v: 


B.8.5  PI  Design  ("C”) 

The  PI  design  has  as  a  first  question  to  the  user 
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whether  he  wishes  to  use  and/or  combine  implicit/explicit 
model  following  by  incorporating  implicit  weights.  If  the 
user  responds  with  no  ("N")  then  execution  of  the  PI  design 
path  entails  user  entry  of  only  explicit  quadratic  weighting 
matrices  defining  the  costs  associated  with  output 
deviation,  control  magnitudes,  and  integrals  of  the 
regulation  error  (see  Figure  B-3) (the  results  of  a  yes 
answer  to  this  question  will  be  discussed  later  in  this 
subsection) : 

OUTPUT  DEVIATION:  Y  (A-3a) 

CONTROL  MAGNITUDES:  SIy  (A-5b) 

INTEGRAL  OF  THE 

REGULATION  ERROR:  Uq  (A-3b) 

For  each  of  these  matrices,  only  the  diagonal 
elements  are  entered.  On  the  first  execution  of  the  PI 
design,  all  weighting  matrices  are  initialized  to  zero. 
Subsequent  iterations  preserve  the  elements  of  these 
matrices  so  only  desired  changes  in  specific  weighting 


elements  need  be  entered.  Weights  on  output  deviations 

should  be  non-negative,  while  weights  on  control  magnitudes 

and  integrals  of  the  regulation  error  should  be  positive. 

Entries  are  tested  for  positive  or  non-negative  values  as 

appropriate.  If  an  entry  is  not  valid,  a  message  is  written 

to  the  user  terminal  and  that  entry  is  not  accepted. 

Matrices  Y  and  U  are  used  to  compute  a 

q 

quadratic  weighting  matrix  on  the  state  deviations  (using  an 
augmented  state  vector  composed  of  system  state  and  integral 
of  the  regulation  error  perturbations  from  nominal) .  This 
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Fig.  B-3--  Continued 
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new  matrix  is  referred  to  as  "£"  (Equations  (III-34c)  and 

(III-35a,b,c) ) .  The  user  may  then  modify  any  element  of  X 

and/or  list  it  at  the  terminal.  Elements  entered  into  X  are 

automatically  set  symmetrically  by  CGTPIQ,  but  the  sign  of 

diagonal  elements  entered  is  not  tested.  X  is  not  preserved 

between  PI  design  iterations,  so  any  desired  changes  in 

elements  with  respect  to  their  values  as  determined  from  x 

and  13^  must  be  re-entered  each  design  pass. 

The  diagonal  elements  of  Y,  2^,  and  are 

printed  at  the  user  terminal  and  the  entire  Y,  U  , 

-  -q 

2^,  and  X  matrices  are  output  to  the  LIST  files.  Next, 
the  controller  gains  and  PI  gains  are  computed.  The  PI 
gains  are  printed  at  the  terminal  ("GC1"  and  "GC2")  and  all 
gains  are  output  to  the  LIST  file.  The  intermediate  product 
"E"  is  also  output  to  the  LIST  file.  The  proportional  "KP" 
and  integral  "KI"  gains  of  the  PI  controller  are  also  output 
to  the  LIST  file. 

The  outputs  to  the  LIST  file  are: 

Y:  Y  (A-3a) 

UQ:  2q  (A-3b) 

UM:  Uy  (A-5b) 

E:  E  (III-28a) 

GC1:  Gcl*  (III-20) 

GC2:  gc2*  (III-20) 

KI:  K i  (III-31C) 

KP:  Up  (III-31b) 

Note  that  the  mnemonics  "UQ"  and  "UM"  refer  to  integral  of 
the  regulation  error  and  input  magnitude  weighting  matrices, 


respectively. 

If  the  user  responded  with  a  yes  to  the  first 
question  of  combining  implicit/explicit  control,  the  program 
prompts  the  user  with  messages  identifying  the  required 
implicit  model** following  related  inputs.  Entries  are 
requested  for  the  command  model  first  (this  need  not  be  the 
same  command  model  as  in  explicit  design  but  the  number  of 
model  states  must  equal  the  number  of  system  outputs,  nM=p) , 
and  then  for  the  quadratic  weighting  on  the  implicit  output 
derivatives  and  then  the  implicit  control  magnitudes.  Note 
that  only  diagonal  elements  can  be  specified  using  the 
format  discussed  previously.  After  entry  of  the  implicit 
quadratic  weights,  the  user  is  permitted  to  see  the  "XIE" 
matrix  (the  upper  left  partition  of  Equation  (III-98))  that 
is  generated  and  he  is  asked  if  new  implicit  weights  are 
required  to  be  entered.  If  yes,  the  program  re-initializes 
the  implicit  matrices  and  asks  for  the  implicit  weights 
again.  If  no,  the  implicit  weighting  matrices  Qj  and 
Rj  are  then  printed  at  the  terminal.  Matrix  is 
the  implicit  output  derivatives  matrix;  matrix  Rj  is  the 
implicit  control  magnitude  matrix.  and  Rj  are 
equivalent  to  Xx  and  Uj  of  Equation  (III-93), 
respectively.  Following  this,  the  program  returns  back  for 
the  normal  explicit  weights  to  be  input  as  discussed 
previously.  The  user  may  design  an  implicit  only  (with 
limitations) ,  explicit  only,  or  a  combined  implicit/explicit 
controller  via  his  selection  of  quadratic  weights.  An 
implicit  model-following  controller  is  pursued  if  the 


explicit  quadratic  weights  are  all  chosen  as  zero 
(limitation:  experience  has  shown  that  UQ  should  not  be  ze«o 
or  the  Riccati  equation  solver  typically  will  not  converge 
to  a  solution  in  the  maximum  permitted  iterations) .  On  the 
other  hand,  an  explicit  model-following  controller  is 
pursued  if  the  implicit  quadratic  weights  are  chosen  as 
zero;  or  if  the  user  responds  with  no  ("N")  to  the  first 
question.  If  the  implicit  or  combined  implicit/explicit 
model-following  is  chosen  the  program  utilizes  the 
appropriate  combined  quadratic  weights  according  to 
Equation  (III-98) .  This  also  results  in  additional  outputs 
to  the  LIST  file 


QIs 

*1 

(III-91) 

RIs 

Hi 

(III-91 ) 

QIH; 

*1 

(III-93a) 

SIH: 

ii 

(III-93b) 

RIH: 

*i 

(III-93C) 

XIE: 

X (modified) (III-98) 

When 

execution 

of  the  PI  design  computations  is 

complete,  the  "controller  evaluation"  set  of  routines  is 
automatically  executed.  These  are  discussed  in  a  later 
subsection  as  a  separate  computational  element. 


B.8.6  CGT  Design  ("D") 

Execution  of  the  "CGT  design"  path  requires  that  a 
command  model  be  established.  If  desired,  a  new  command 
model  can  be  established  during  any  iteration  of  the  design. 
The  model  is  actually  entered  using  the  routines  described 

B-37 


in  Section  B.8.3  above  ("Establishing  Dynamics  Models"). 

If  PI  gains  already  exist  in  the  program  storage, 
then  a  closed- loop  CGT/PI  design  is  effected  automatically. 
If  not,  the  user  may  elect  to  have  the  program  read  the  PI 
gains  from  the  DATA  file  and  design  a  closed- loop  CGT/PI 
controller.  However,  if  the  user  chooses  not  to  have  the 
gains  read  from  DATA  or  if  the  gains  are  found  not  to  exist 
on  the  DATA  file,  an  open- loop  CGT  design  is  effected 
automatically  (by  setting  PI  gains  to  zero) ,  but  only  if  the 
open- loop  system  is  stable.  For  either  open-or  closed- loop 
CGT  design,  the  matrices  A^j  (Equation  (III-61))  are 
automatically  output  to  the  LIST  file. 

Figure  B-4  illustrates  the  I/O,  logic,  and 
computations  of  the  CGT  design  path.  Details  involved  in 
entering  the  command  model  are  given  in  Section  B.8.3  and 
are  indicated  in  this  figure  by  a  block  titled  "Establish 
Command  Model".  Note  that  since  the  continuous-time 
representation  of  the  command  model  is  not  preserved, 
"modification"  of  the  command  model  actually  entails 
complete  redefinition  of  it.  In  case  the  command  model 
exists  on  the  DATA  file  and  only  specific  elements  are  to  be 
changed,  this  can  be  accomplished  readily  by  reading  the 
model  from  DATA  and  then  modifying  individual  arrays  (as 
shown  in  Figure  B-2c) . 

In  establishing  the  command  model,  I/O  is  as 
described  in  Section  B.8.3.  Additional  output  to  the  LIST 
file  is 

Alls  An  (III-61a) 
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A21: 

—21 

(III-61d) 

A12: 

—12 

(III-61b) 

A22: 

-22 

(III-61e) 

A13: 

-13 

(III-61C) 

A23: 

^23 

(III-61f ) 

KXM: 

&xm 

(A-24a) 

KXU: 

-xu 

(A-24b) 

KXN: 

&xn 

(A-24c) 

The  controller  gains  ("KXM",  "KXU",  and  "KXN")  are  also 
printed  directly  at  the  user  terminal.  Note  that  arrays 
A^,  A23z  and  exist  only  if  disturbance 
states  are  specifically  modeled  in  the  design  model  (n^ 
of  Equations  (B-la,b)). 

When  execution  of  the  CGT  design  computations  is 
complete,  the  "controller  evaluation"  set  of  routines  is 
automatically  executed.  These  are  discussed  in  the  next 
subsection. 

B.8.7  Controller  Evaluation  ("E") 

A  single  set  of  routines  performs  the  controller 
evaluation  for  both  the  PI  and  CGT  designs.  For  the  PI 
controller,  the  poles  of  the  closed- loop  discrete-time 
system  matrix  JLjcl  (Equation  (A-18))  are  computed  and 
mapped  into  the  primary  strip  in  the  continuous- time  domain 
(the  z-plane  poles  are  not  listed  in  output).  These  mapped 
closed- loop  poles  are  printed  to  both  the  user  terminal  and 
the  LIST  file.  The  primary  evaluation  tool  for  both 
controllers  is  a  time-response  simulation.  For  the  PI 


controller,  the  response  is  taken  for  non-zero  initial 
conditions  (IC's)  on  the  states;  for  the  CGT  controller  the 
response  is  given  for  a  step  input  on  any  of  the  command 
model's  inputs.  In  either  case,  the  system  dynamics  can  be 
propagated  using  the  design  model  or  truth  model  state 
transition  equations.  Time  response  runs  may  be  run 
repeatedly  for  a  specific  controller  design. 

The  I/O,  logic,  and  computations  involved  in  the 
controller  evaluation  are  shown  in  Figure  B-5.  Decision 
blocks  labeled  "CGT"  test  for  the  type  of  controller  being 
evaluated  (CGT  or  PI).  Decision  blocks  labeled  "LTEVAL" 
test  if  the  truth  model  is  being  used  to  propagate  system 
dynamics  (if  not,  the  design  model  is  being  used). 

The  first  prompt  of  the  controller  evaluation 
computational  element  asks  if  the  evaluation  is  to  be 
conducted  with  respect  to  truth  model  dynamics.  If  yes,  the 
truth  model  may  be  established  or  modified  (if  previously 


established)  in  the  manner  described  in  Section  B.8.3  above. 
Note  that,  since  the  continuous-time  representation  of  the 
truth  model  is  not  preserved  within  CGTPIQ,  "modifications" 
actually  entails  complete  redefinition  of  the  model.  In  the 
case  that  the  truth  model  exists  on  the  DATA  file  and  only 
specific  array  elements  are  to  be  modified,  it  is  convenient 
simply  to  read  the  truth  model  from  the  DATA  file  and  modify 
matrix  elements  as  shown  in  Figure  B-2c.  If  the  truth  model 
had  been  established  previously  and  no  modification  to  it  is 


desired,  the  existing  discrete-time  representation  of  the 
truth  model  is  used.  The  design  model  is  used  to  propagate 
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system  dynamics  if  the  truth  model  evaluation  is  not 
selected. 

For  the  C6T  evaluation,  the  first  input  prompt  is 
for  the  index  of  the  command  input  vector  to  which  a  step 
input  is  to  be  applied,  and  the  magnitude  of  that  step  (only 
one  command  input  is  allowed  at  a  time) .  CGTPIQ  tests  the 
input  index  for  validity  (within  vector  length  bounds) ;  if 
it  is  invalid  the  prompt  is  repeated.  If  the  index  is  zero 
(or  negative)  the  input  is  not  accepted  and  the  user  is 
queried  as  to  whether  time-response  runs  are  desired.  If  no 
time-responses  are  to  be  run,  the  controller  evaluation 
routines  are  exited;  otherwise,  the  prompt  requesting 
command  model  input  specification  is  repeated.  If  the  CGT 
controller  response  is  to  be  run,  initial  conditions  on  the 
system  states  may  be  entered.  If  the  design  model  is  used 
for  evaluation  and  disturbance  states  exist  in  the  model, 
they  may  be  given  initial  conditions  also. 

For  the  PI  evaluation  the  first  input  prompt  is  for 
initial  conditions  for  the  system  states.  The  states  that 
are  actually  given  initial  values  are  those  of  the  design  or 
truth  model,  according  to  the  model  used  for  propagation  of 
dynamics.  Initial  conditions  are  entered  for  either 
controller  in  the  same  manner.  Entry  is  of  the  index  of  the 
state  within  its  appropriate  state  vector  (design  or  truth 
model,  or  disturbance  state  vectors)  and  its  initial  value. 
Tests  and  termination  of  entry  are  as  described  in  section 
B.8.2  for  multiple  entries. 


B.8.7.1  Time  Response  Plots 


[v 


I  <9 
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Time-response  plots  are  of  the  "line  printer"  type 
and  are  output  both  to  the  terminal  and  to  the  LIST  file. 

As  many  as  two  plots,  each  with  as  many  as  five  dependent 
variables,  may  be  printed  at  the  user  terminal.  CGTPIQ 
prompts  the  user  to  specify  the  number  of  variables  for  each 
of  the  two  plots  (the  user  is  to  enter  two  integers).  If 
the  user  enters  non-positive  integers  for  both  plots,  then  a 
prompt  queries  the  user  as  to  whether  time-response  runs  are 
desired.  If  no  time-responses  are  to  be  run,  the  routines 
are  exited.  Note  that  when  no  plots  are  selected  for 
terminal  printing,  none  are  output  to  LIST  either  and  no 
time-responses  are  simulated. 

In  the  case  that  plots  are  to  be  printed  at  the 
terminal,  a  series  of  prompts  allow  the  user  to  specify 
exactly  which  variables  shall  be  included.  Variables  are 
selected  by  specifying  a  name  of  the  vector  type  for  that 
variable  and  its  index  in  two  entries  for  each  variable. 

The  names  of  the  vectors  are: 

X:  system  state  vector 

Y:  system  output  vector 
U:  system  input  vector 

D:  disturbance  state  vector 
M:  command  model  output  vector 
The  system  state  vector  is  that  of  the  design  or  truth 
models,  according  to  the  model  used  for  propagation  of 
dynamics.  For  example,  the  pair  of  entries  "U"  and  "1" 
specifies  that  element  1  of  the  input  vector  U  is  to  be 
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plotted  (note  that  "entry"  includes  a  carriage  return).  The 
input  prompt  includes  these  definitions  and  includes  only 
those  variables  relevant  to  the  controller  being  evaluated. 
The  model  output  and  disturbance  state  vectors  are  only 
offered  for  C6T  evaluations,  and  for  the  latter  also  only  if 
the  disturbance  states  are  explicitly  modeled  and  the  design 
model  propagates  dynamics  of  the  time-response  (since  for 
the  truth  model  the  system  state  vector  includes  all 
disturbance  states  which  are  considered  to  act  on  the 
system) .  Each  user  entry  is  tested  for  valid  (and  relevant) 
name  and  for  valid  index.  Prompts  specify  the  plot  number 
and  output  number  for  each  requested  entry. 

The  user  next  is  prompted  to  enter  the  time 
duration  for  the  simulation.  However,  the  duration  actually 
simulated  may  be  adjusted  by  the  program:  a  time  span  that 
is  the  nearest  integer  multiple  of  100  times  the  controller 
sample  period  is  selected.  Plots  to  the  LIST  file  include 
the  entire  time  span  and  use  100  equal  time  interval 
samples.  Plots  to  the  terminal  include  50  time  samples 
selected  as  follows:  if  the  time  duration  specified  by  the 
user  is  less  that  50  times  the  controller  sample  period,  the 
samples  plotted  are  the  first  50  time  samples  from  the 
simulation:  otherwise,  the  entire  time  span  is  included  in 
50  equal-interval  samples.  Thus,  for  example,  with  a 
controller  sample  period  of  .02  seconds,  a  user-specified 
time  duration  of  less  than  1.  second  would  yield  plots  to 
the  terminal  running  from  time*0.  to  time»l.  and  with  .02 
seconds  between  each  sample;  plots  to  the  line  printer  from 
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ft 


LIST  would  include  samples  at  the  same  interval  but 


extending  to  tirae»2. 


After  completing  the  time-response  simulation,  a 


prompt  requests  a  title  for  the  plot  and  prescribes  the 


field  width  available  for  the  entry  (50  characters).  The 


title  is  applied  to  all  plots  generated  from  the  single 


simulation. 


Plots  are  printed  with  the  independent  (time)  axis 


running  vertically  along  the  length  of  the  output  page  with 


the  origin  at  the  top.  Each  sample  time  is  identified  along 


the  left  margin  of  the  plot.  The  dependent  axis  is 


horizontal.  Each  variable  is  marked  with  an  integer  from  1 


to  5  at  each  sample  time.  Note  that  since  only  one 


character  can  be  printed  in  each  location  of  the  plot  field. 


when  two  or  more  variables  would  occupy  a  single  print 


position  at  a  sample  time,  only  the  symbol  of  larges  value 


(1  to  5)  is  printed.  For  plots  to  the  terminal,  if  a  model 


output  is  among  the  variables  of  a  plot,  then  all  variables 


in  the  plot  are  plotted  over  a  single  scale  range  to 


facilitate  comparison  of  actual  and  desired  output 


responses.  In  all  other  cases  every  variable  plotted  is 


scaled  over  its  own  range  independently  in  order  to  achieve 


greater  resolution  for  each  in  the  plot  field.  The  scale (s) 


are  listed  along  the  bottom  of  the  plot.  Rotation  of  the 


output  page  through  90  degrees  in  a  counter-clockwise  sense 


gives  the  usual  abscissa-ordinate  orientation.  Terminal 


plots  are  50  print  positions  wide;  plots  to  LIST  are  100 


print  positions  wide. 


B-47 


Plots  of  all  relevant  variables  in  a  time-response 
simulation  (all  states,  inputs,  and  so  on)  are  automatically 
output  to  the  LIST  file  if  terminal  plots  are  requested. 

Five  variables  are  included  in  each  plot.  A  list 
identifying  all  the  variables  by  type  and  index  for  each 
plot  number  and  plot  symbol  is  written  to  LIST  prior  to  the 
plots. 

When  all  plots  have  been  printed,  a  prompt  queries 
the  user  as  to  whether  additional  time-response  runs  are 
desired.  If  more  are  wished,  the  entire  set  of  plotting 
options  is  repeated  and  the  same  controller  may  be  evaluated 
under  different  conditions  and/or  different  variables  may  be 
plotted.  If  no  additional  simulations  are  wished,  the 
controller  evaluation  routines  are  exited. 

B.8.8  Kalman  Filter  Design  ("F") 

The  Kalman  filter  design  routines  compute  the 
steady-state  Kalman  filter  gains  for  the  design  model. 

Figure  B-6  shows  the  I/O,  logic,  and  computations  involved. 
Note  that  the  first  execution  of  the  filter  design  path 
bases  its  filter  computations  on  the  noise  strengths 
specified  upon  initial  entry  of  the  design  model.  In 
subsequent  executions,  any  of  the  noise  strengths  may  be 
modified.  The  noise  strengths  are  entered  as  vectors  of  the 
matrix  diagonals  (only  diagonal  elements  may  be  modified). 
The  matrices  are 

"STATE  NOISE  STRENGTHS":  Q  (B-2a) 

•DISTURBANCE  NOISE  STRENGTHS" :0  (B-2b) 

-*n 


Kalman  Filter  Design 


"MEASUREMENT  NOISE  STRENGTHS" (B-2c) 

Prompts  for  state  or  disturbance  noise  strengths  are  given 
only  if  the  design  model  specifies  driving  noises  for  the 
respective  process  dynamics.  Negative  noise  strengths  are 
not  accepted. 

In  each  execution  of  the  filter  design  path  the 
entire  noise  strength  matrices  and  Kalman  filter  gain  matrix 
are  output  to  the  terminal  and  LIST  file.  However,  only  the 
diagonal  elements  of  the  noise  strength  matrices  are  printed 
at  the  terminal. 

Following  computation  of  the  filter  gains,  the 
Kalman  filter  design  routines  are  exited.  Execution 
proceeds  automatically  to  the  filter  evaluation 
computational  element  described  in  the  next  subsection. 

B.8.9  Filter  Evaluation  ("G") 

Figure  B-7  shows  the  I/O,  logic,  and  computations  of 
the  filter  evaluation  routines.  Execution  of  the  filter 
evaluation  requires  that  the  system  truth  model  be 
established,  since  the  covariance  analysis  is  performed  with 
respect  to  the  truth  model.  Comments  in  Section  B.8.7 
dealing  with  establishing  the  truth  model  apply  equally  in 
this  set  of  routines,  except  that  here  use  of  the  truth 
model  is  not  optional. 

Evaluation  begins  with  computation  of  the 
eigenvalues  of  the  system-filter  matrix  |RF  (Equation 
(D-6)).  As  for  the  closed- loop  PI  regulated  system,  the 
discrete-time  eigenvalues  are  mapped  to  the  primary  strip  in 


the  continuous-time  domain.  These  mapped  poles  are  printed 
at  the  user  terminal  and  output  to  the  LIST  file  (the 
z-plane  eigenvalues  are  not  printed). 

The  primary  evaluation  tool  applied  to  the  filter 
design  is  a  steady-state  covariance  analysis.  The 
covariance  matrix  of  the  estimation  errors  of  the  filter 
using  measurements  of  the  truth  model  dynamics  is  propagated 
for  50  filter  (controller)  sample  periods.  Samples  are 
coincident  with  the  filter's  sample  times  and  the  total 
number  is  fixed  at  50.  At  each  time  sample  the  standard 
deviations  of  these  "true"  errors  are  computed  as  the 
square-roots  of  the  diagonal  elements  of  the  error 
covariance  matrix.  The  filter's  own  computed  error 
covariance  matrix,  because  of  the  steady-state  assumption, 
is  constant  for  all  time  samples.  Taking  the  square-roots 
of  the  diagonal  elements  then  gives  the  filter's  estimate  of 
the  standard  deviations  of  its  errors  in  state  estimation. 
Plots  for  each  state  are  output  to  the  LIST  file  showing  the 
"true"  and  "computed"  RMS  errors  for  the  50  time  samples.  A 
title  may  be  entered  to  be  applied  to  all  plots  from  the 
covariance  analysis.  In  addition,  the  "true"  and  "computed" 
RMS  errors  at  the  final  time  sample  are  printed  at  the 
terminal. 

This  completes  the  filter  evaluation.  A  new  filter 
design  may  then  be  pursued,  or  any  other  design  option  may 
be  selected. 


B.8.10  Performance  Evaluation  Data  ("H") 


h: 


$ 

A 


In  performance  evaluation  data,  the  performance  data 
determined  throughout  the  program  is  written  to  the  SAVE 
file  (via  the  user's  response  to  input  prompts)  for  use  in 
the  performance  evaluation  accomplished  via  the  program 
"PFEVAL"  (Ref  21).  (As  a  special  note,  if  this  data  is  to 
be  used  in  the  program  "PFEVAL*,  the  SAVE  file  must  be 
transferred  to  a  DATA  file  as  discussed  previously). 

Decision  blocks  "filter  designed  yet"  and  "CGT/PI  designed 
yet"  correspond  to  program  decision  "flags".  Note  that 
performance  data  may  be  written  to  the  SAVE  file  from  either 
the  controller  or  the  filter  design  path. 

B .9  Program  Messages 

A  variety  of  messages  may  be  printed  at  the  terminal 
and/or  output  to  the  LIST  file  during  program  execution. 

Some  are  purely  informational,  are  clear  in  their  meaning, 
and  provide  no  essential  insight  into  progress  of  the  design 
or  possible  difficulties  in  program  execution.  Such 
messages  are  not  discussed  here.  The  remaining  messages 
relate  to  errors  or  potential  design  difficulties  and  are 
considered  in  categories  of  memory  allocation,  dimensional 
errors,  or  computational  problems. 

B.9.1  Memory  Allocation 

CGTPIQ  uses  vectors  in  named  Commons  for  array 
storage.  These  vectors  are  dimensioned  in  the  main  routine 
and  a  variable  in  the  Common  is  set  to  the  value  allocated. 
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These  vectors  are  then  partitioned  within  CGTPIQ  to  store 
individual  arrays.  Before  storing  arrays  into  each  vector 
in  Common,  the  storage  needed  is  computed.  In  the  case  of 
temporary  storage  vectors,  at  each  point  in  execution  at 
which  a  new  allocation  is  needed,  the  required  storage  is 
recomputed.  If  more  memory  will  be  needed  in  a  vector  than 
has  been  allocated,  a  message  is  written  specifying  the  name 
of  the  Common  and  the  necessary  minimum  allocation.  A 
typical  message  of  this  type  is 

"INSUFFICIENT  MEMORY  /SYSMTX/,  NEED:  nnnn" 
in  which  the  common  /SYSMTX/  has  too  little  storage  for  the 
problem  and  'nnnn'  is  the  dimension  required  for  the  vector 
in  that  common.  For  the  vectors  containing  the  dynamics 
models,  the  model  with  insufficient  memory  is  identified  by 
name.  The  Commons  for  the  design,  truth,  and  command  models 
are  /DSNMTX/ ,  /TRUMTX/ ,  and  /CMDMTX/ ,  respectively.  After 
printing  such  a  message  to  the  user  terminal,  execution  is 
aborted. 

In  its  existing  form,  CGTPIQ  will  have  sufficient 
vector  allocations  to  deal  successfully  with  problems  of 
many  different  combinations  of  dimensions  and  with  system 
matrices  in  the  range  of  10  to  20  states.  Since  the  program 
will  not  allow  allocated  memory  to  be  exceeded,  it  is 
reasonable  to  attempt  any  given  problem  and  let  the  program 
either  deal  with  it  successfully,  or  let  it  write  the 
appropriate  memory  message  if  the  problem  cannot  be 
accommodated.  (Section  A. 9  of  the  programmer's  manual  of 
the  thesis  by  Floyd  (Ref  9)  discusses  the  steps  necessary  to 


cv* 


obtain  a  new  CGTPIQ  with  different  memory  allocations) 


B.9.2  Dimensional  Errors 

As  each  of  the  dynamics  models  is  established#  or 
just  prior  to  computations  which  assume  relations  among  the 
design  and  command  system  and  disturbance  state  dimensions 
(CGT  computations) #  the  dimensional  constraints  mentioned 
previously  are  tested*  In  terms  of  the  dimension  notation 
of  Equations  (B-4)#  (B-8)#  and  (B-ll)  the  constraints  are 
Design  model:  p=r  and  n>d 


Truth  model: 


rT=r  and  nym 


Command  model:  p*p  and  n^n„ 

p=nM  (for  implicit  design  only) 

If  such  a  constraint  is  not  satisfied#  a  message  is  written 
to  the  user  terminal  identifying  the  problem  and  execution 
is  aborted.  When  the  constraint  affects  only  a  specific 
section  of  code#  or  if  redefinition  of  the  model  (command  or 
truth)  can  resolve  the  error#  then  only  the  affected 
execution  path  is  aborted.  In  other  cases#  execution  is 
aborted  completely. 

Other  dimensional  tests  are  made  in  the  Kalman 
filter  design  and  evaluation  computational  elements.  For 
filter  design,  it  is  necessary  that  the  system  state  and 
disturbance  state  driving  noise  dimensions  not  both  be  equal 
to  zero#  and  that  the  number  of  measurements  be  non-zero. 
These  are  constraints  on  the  design  model: 
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v.v.w.v.vVa*: 


•/  O  V*  *  *  •  1 


For  filter  evaluation,  the  number  of  driving  noises  for  the 
truth  model  must  be  non-zero: 
wT>0 

since  in  the  case  of  wT*0,  the  system  is  deterministic 
and  the  covariance  analysis  would  not  provide  much  useful 
information  for  evaluation  of  the  filter's  performance.  If 
any  of  these  constraints  are  not  satisfied,  a  message  is 
written  to  the  user  terminal  identifying  the  problem  and 
execution  of  the  filter  design-evaluation  computational 
elements  is  aborted. 

B.9.3  Computational  Problems 

In  certain  of  the  computations,  characteristics  of 
the  particular  design  problem  may  be  identified  as  having 
potential  impact  on  the  attainment  of  design  objectives. 
Messages  identifying  these  characteristics  may  be  considered 
informational.  Other  messages  describe  computational 
problems  that  are  immediately  fatal. 

In  computing  the  Pi  matrix  of  Equation  (11-18),  a 
pair  of  messages  may  be  generated  to  the  LIST  file: 

"PI  MATRIX  IS  RANK  DEFECTIVE" 

and 


"nr  X  nc  MT  RANK  mr" 


in  which  "nr"  and  "nc"  are  the  row  and  column  dimensions  of 
the  Pi  matrix  and  "mr"  is  it  rank.  The  first  message  is 
also  printed  at  the  user  terminal.  The  equations  employing 
Pi  assume  it  to  be  an  ordinary  matrix  inverse.  If  it  is 
rank  defective,  the  matrix  pseudo-inverse  is  computed 
instead.  Execution  of  the  program  continues  since  useful 
results  may  still  be  obtained  through  use  of  the 
pseudo- inverse  (Ref  18:124). 

Solution  of  the  Riccati  equations  for  the  PI 
controller  and  the  Kalman  filter  is  achieved  using  an 
iterative  algorithm  (Ref  12)  which  may  generate  messages  of 
information  or  fatal  error.  The  information  message  for  the 
PI  is, 

"RICCATI  SOLN  IS  PSD — RANK  mr" 

in  which  "PSD"  means  positive  semi-definite.  For  the  Kalman 
filter  the  corresponding  message  is, 

"OBSERVABILITY  MATRIX  IS  nr  X  nc  OF  RANK  mr" 
in  which  "nr",  "nc",  and  "mr"  are  the  row,  column  dimensions 
and  the  rank,  respectively.  These  messages  convey  the  same 
information  concerning  system  observability.  The  message  is 
written  in  the  case  of  the  PI  Riccati  equation  only  if  the 
solution  is  positive  semi-definite  (rank  defective).  Both 
messages  are  output  to  the  LIST  file  only. 

For  both  the  PI  and  filter  Riccati  equations  fatal 
error  messages  are  identical: 

"RICCATI  NON-CONVERGENT  IN  nn  ITERATIONS" 


or 


"RICCATI  BLOW  UP  AT  ITERATION  nn  INITIAL  N  =  mm" 
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in  which  "nn"  is  the  iteration  counter  at  the  occurrence  of 
the  error  and  "ram"  is  the  value  of  a  variable  set  internally 
and  used  in  achieving  initialization  of  the  iterative 
sequence  (the  internal  variable  is  not  available  for 
modification  by  the  user).  The  first  message  indicates  that 
the  sequence  of  iterates  did  not  converge.  The  second 
message  may  indicate  numerical  difficulties  or 
uncontrollability  (unobservability)  of  the  system  of  the  PI 
(filter)  equations.  Both  messages  are  output  to  the  LIST 
file  only;  a  system  error  exit  routine  is  then  called  which 
writes  "EXIT"  to  the  user  terminal  and  aborts  program 
execution.  Note  that  in  the  event  of  such  an  abort,  the 
local  files  SAVE,  DATA,  and  LIST  are  not  rewound 
automatically. 

In  computing  the  CGT  controller  gains  an  error  may 
occur  in  solving  for  the  matrix  partitions  A^  or 
A^j  (Equation  (III-61)).  If  the  iterative  refinements 
to  these  solutions  do  not  converge  to  within  the  established 
tolerance  (l.E-6),  then  the  following  message  is  written 
both  to  the  terminal  and  the  LIST  file: 

■SOLUTION  ERROR  FOR  ’A'  (CGT)  AFTER  3  ITERATIONS  * 

nnn" 

in  which  "nnn"  is  the  Euclidean  norm  of  the  refining  matrix 
solution  (residual)  at  the  last  iteration.  The  message  is 
considered  to  be  infomational,  and  execution  proceeds 
normally.  However,  in  case  the  value  of  the  residual  norm 
is  large  compared  to  the  convergence  tolerance,  the  CGT 
design  solution  can  be  expected  to  be  invalid. 


B *10  CGTPIQ  Segmentation  Job  Control 

The  following  listing  shows  the  job  control  commands 
and  segmentation  directives  used  in  obtaining  a  segmented 
object  file  suitable  for  interactive  execution  on  the  CDC 
CYBER  computer  system.  The  job  employs  three  object  files: 
"L",  "S",  and  "A".  The  routines  on  each  of  these  files  are 
(see  the  program  listing) 

"L":  'MAIN'  and  all  optional  routines ( 'MAIN'  through 
' TBLUPl ' ) 

"S":  'CGTPIQ  SUBS'  ( 'CGTXQ '  through  'VARSCL') 

"A":  'LIBRARY' 

Object  files  L  and  S  are  loaded  into  memory  in  the  order  of 
MAIN,  then  CGTPIQ  SUBS.  The  "NOGO"  command  then  completes 
the  load  from  LIBRARY  and  system  routines  in  order,  but  does 
not  initiate  execution.  Next,  the  segmentation  directives 
are  executed  (segmentation  directives  appear  between  the 
pair  of  "*EOR"  lines).  When  segmentation  is  complete,  the 
resulting  object  file  is  cataloged. 

In  this  listing,  the  names  given  the  various  object 
files  ("L",  "S",  "A")  are  arbitrary,  and  the  "ATTACH" 
commands  may  occur  in  any  order.  The  file  name  ("lfn") 
given  in  the  "LIBRARY, lfn"  command  must  correspond  to  the 
name  used  in  attaching  the  object  file  of  'LIBRARY' 
routines.  The  name  given  to  the  segmented  object  file  is 
arbitrary  but  must  be  consistent  in  the  "REQUEST”, 

"SEGLOAD",  and  "CATALOG"  commands.  The  segmentation 
directives  should  not  be  modified  in  any  way. 
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100s JPM.  T830287 , MCMILLIAN 
1 10=MAP,FULL. 

120s ATT ACH,CGTX. 

1 30s ATTACH , OLKLIB , IDsT820303 . 

1 40sLIBR AR Y , DLKLIB . 

1 50sREQUEST, CGTPIQ ,»PF. 

160sSEGL0AD(BsCGTPIQ) 

170«LOAD(CGTX) 

180*NOGO. 

190sREWIND, CGTPIQ. 

200sCATAL0G, CGTPIQ, CGTPIQ. 

210s*E0R 

220sSETUP  INCLUDE  DSCRT 

230sSREGPI  INCLUDE  RQWGTS,MLINEQ,SYMFCT 

240sFLTRK  INCLUDE  RQWGTS , KFLTR , MLI NEQ , S YMFCT , INTEG 

250sSTRTH  INCLUDE  DSCRTT, INTEG 

260=SDSN  INCLUDE  QDSCRT 

270sCEVAL  INCLUDE  PLOTLP , VARSCL, RPLOTF , WPLOTF, STRPLT 

280sFEVAL  INCLUDE  PLOTLP, VARSCL, RPLOTF, WPLOTF, STRPLT, DACOV 

290sB1  TREE  SETUP-(SDSN,SCMD,STRTH) 

300sB2  TREE  PIMTX 

310=B3  TREE  SREGPI 

320sB4  TREE  SCOT 

330sB5  TREE  CEVAL 

340=B6  TREE  FLTRK 

350sB7  TREE  FEVAL 

360sB8  TREE  PFDATA 

370=A  TREE  CGTXQ-(B1,B2,B3,B4,B5»B6,B7,B8) 

3 80s ROOT  TREE  MAIN-A 

390s  GLOBAL  NAIN1 , HAIN2,IN0U, DESIGN, FILES, SYSMTX, ZHTX1 ,ZMTX2, 

4 00s , NDIMD , LOCD , DSNMTX , NDIMC , LOCC , CMDMTX , NDIMT , LOCT , TRUMTX , LCNTRL , CONTROL , 

4 10s , LREGPI , CREGPI , LCGT , CCGT , LKF , CKF , AMC , BDG 

420s  END 

430s«EOR 

440s»EOF 
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B * 11  Running  CGTPIQ 

This  "User's  Guide”  assumes  that  a  segmented 
executable  object  file  of  CGTPIQ  exists  according  to  the 
previous  section.  For  an  existing  CGTPIQ  object  file  in  the 
permanent  file  system,  the  following  commands  must  be 
entered  in  INTERCOM  to  run  the  program: 

CONNECT , INPUT , OUTPUT 
ATTACH, CGTP IQ, pfn 
CGTPIQ 

in  which  'pfn'  is  the  permanent  file  on  which  the  object 
file  is  cataloged.  CGTPIQ  will  then  execute  as  described  in 
Section  B.8.  Additional  commands  before  and  after  execution 
may  be  appropriate  according  to  one's  intended  use  of  the 
various  local  files  which  CGTPIQ  employs  during  execution 
(like  attaching  a  DATA  file). 

B.12  CGTPIQ  Input/Output  Listing 

The  input/output  (I/O)  listing  given  at  the  end  of 
this  section  is  from  a  single  execution  of  CGTPIQ.  It  shows 
a  CGT  design,  a  PI  controller  design,  a  CGT/PI  controller 
design,  and  a  Kalman  filter  design  for  a  simple  design 
model.  Details  concerning  the  design,  truth,  and  command 
models  employed  are  presented  in  Section  B.12. 2.  The  models 
were  selected  to  test  the  program  thoroughly  and  give  the 
user  a  good  feel  for  program  execution.  The  models  are 
otherwise  meaningless  in  the  real  world  context.  The  I/O 
shown  is  that  obtained  directly  at  the  user  terminal  during 
execution.  The  listing  is  complete  and  in  order.  The 


additional  information  written  to  the  LIST  file  is  not 


presented  here  but  the  last  section  of  this  guide  gives  a 
brief  description  of  the  output  appearing  on  a  LIST  file. 

Prior  to  and  following  program  execution,  INTERCOM 
prompts  for  input  are  given  by  "COMMAND-".  Within  program 
execution  entries  occur  in  two  ways:  (1)  when  the  entry  is 
on  the  same  line  as  an  input  prompt,  the  entry  is  bounded  on 
the  left  by  the  symbol  ">";  (2)  in  case  of  multiple  entries 
for  a  single  prompt,  the  second  and  subsequent  entries  are 
not  prompted  but  are  entered  on  the  next  lines,  one  entry 
per  line. 

Portions  of  I/O  are  discussed  within  individual 
numbered  paragraphs.  Each  portion  of  listing  is  identified 
by  a  number  in  parentheses  at  the  top  center  of  the  page 
where  it  begins,  and  these  numbers  correspond  to  the 
paragraph  numbers  below. 

B.12.1  Summary  of  Input/Output 

(1)  Following  "LOGIN",  the  executable  object  file 
'CGTPIQ'  is  attached.  Next,  permanent  file  space  is 
requested  for  the  local  file  name  'SAVE';  the  SAVE  file  will 
be  generated  during  subsequent  execution  of  the  program. 

The  "CONNECT"  command  defines  the  user  terminal  as  the 
device  that  communicates  through  the  FORTRAN  standard 
'INPUT'  and  'OUTPUT'  files.  Program  execution  is  initiated 
with  the  simple  command  "CGTPIQ",  which  loads  the  local  file 
CGTPIQ  and  begins  execution  at  its  starting  address. 

(2)  Program  execution  begins  with  output  of  an 


identifying  header  which  includes  the  current  date  and  time 
(obtained  from  a  call  to  system  real-time  clock  routines) . 
The  first  user  entry  is  the  sample  period  of  the  controller. 
Next,  the  design  model  is  established  under  prompt  from  the 
terminal.  The  design  model  is  then  written  to  the  SAVE 
file.  The  poles  (eigenvalues)  of  the  design  model  (A 
matrix)  are  automatically  computed  and  printed. 

(3)  The  controller  design  path  is  then  pursued  with 
selection  of  an  open-loop  CGT  design  requested  (since  there 
are  no  PI  gains  yet) .  The  command  model  is  then  input, 
written  to  the  SAVE  file,  and  the  poles  of  the  command 
matrix  (&m)  automatically  output.  An  informational 

error  message  is  then  printed.  This  does  not  affect 
operation  but  the  validity  of  the  solution  is  in  question 
(see  Section  B.9) . 

(4)  The  open- loop  CGT  gains  (KXM,  KXU  and  KXN)  are 
then  computed  and  printed.  The  evaluation  is  chosen  with 
respect  to  the  truth  model,  so  the  truth  model  is  input  next 
and  written  to  the  SAVE  file.  The  poles  of  the  truth  matrix 
(&t)  are  automatically  computed  and  printed. 

(5)  A  step  of  magnitude  one  is  input  on  model  input 
one.  There  are  no  initial  conditions  (IC)  placed  on  the 
states.  One  plot  of  two  variables  is  selected  with  Y1  and 
Ml  being  the  variables  to  be  plotted.  A  plot  duration  of 
one  second  is  chosen  and  a  title  given  to  the  plot.  The 
open-loop  CGT  time  response  is  then  plotted  at  the  terminal. 

(6)  A  PI  design  is  chosen  next  and  implicit  model 
following  requested,  but,  since  the  command  model  state 


dimension  did  not  equal  the  design  model  output  dimension, 
this  request  was  aborted  (another  command  model  would  need 
to  be  input  to  use  the  implicit  path).  The  explicit  weights 
were  then  input  and  displayed  with  the  (2,2)  element  of  the 
X  matrix  being  modified.  (Note  that  the  X  matrix  is 
computed  anew  each  iteration  from  the  weighting  matrices  on 
the  outputs  and  on  the  integral  of  the  regulation  error. 
Thus,  modifications  made  explicitly  to  X  are  not  preserved 
between  design  iterations.) 

(7)  The  PI  gains  GC1  and  GC2  are  computed  and 
displayed  followed  by  the  printout  of  the  continuous** time 
mapped  poles  of  the  closed  loop  system  matrix  (note  the  lack 
of  one  complex  complementary  pole  of  the  closed-loop  system 
matrix:  when  this  happens  it  usually  indicates  a  poor 
choice  of  quadratic  weights,  sampling  time,  etc.,  and  a 
potentially  useless  design,  and  is  caused  by  a  pole  in  the 
right-half  z-plane  not  being  able  to  be  mapped  to  the 
s-plane) .  Initial  conditions  of  one  are  placed  on  states 
one  and  two,  and  one  plot  of  three  variables  is  requested 
with  X2,  Y1  and  U1  being  the  variables  to  be  plotted.  A 
plot  duration  of  one  second  is  requested  and  a  title  given 
to  the  plot.  The  time  response  plot  of  the  PI  controller  is 
then  presented. 

(8)  A  closed-loop  CGT/PI  is  then  selected  since  the 
PI  gains  have  been  computed.  The  CGT/PI  gains  (KXM,  KXU  and 
KXN)  are  computed  and  printed.  Controller  evaluation  with 
respect  to  the  truth  model  is  selected,  a  step  input  of 
magnitude  one  placed  on  model  input  one,  and  zero  initial 


conditions  placed  on  the  states.  One  plot  of  two  variables 
is  requested  with  Y1  and  Ml  chosen  as  the  variables.  A 
duration  of  one  second  is  chosen  and  a  plot  title  is  given. 
The  closed- loop  CGT/PI  time  response  is  then  plotted  at  the 
terminal.  Note  the  difference  in  performance  between  the 
open-loop  CGT  and  the  closed- loop  CGT/PI  controllers. 

(9)  No  additional  time-responses  of  the  CGT/PI 
controller  are  requested.  The  Kalman  filter  path  is  then 
selected.  Since  this  is  the  first  execution  of  the  Kalman 
filter  design,  the  noise  strength  matrices  (Q  and  R) 
specified  in  the  existing  definition  of  the  design  model  are 
used  to  compute  the  Kalman  filter  gain  matrix  (note  that  in 
subsequent  iterations  of  the  Kalman  filter  design  path,  the 
user  may  modify  the  diagonal  elements  (only)  of  the  noise 
strength  matrices).  The  diagonal  elements  of  the  noise 
strength  matrices  and  the  entire  filter  gain  matrix  are 
printed.  Next,  a  title  is  entered  to  apply  to  the  plots  of 
state  estimation  error  standard  deviations  (output  to  LIST 
file  only).  The  final  values  of  true  and  filter  computed 
RMS  errors  for  the  design  model  state  estimates  are  printed. 
The  performance  evaluation  data  is  then  written  to  the  SAVE 
file.  (This  is  the  information  needed  by  the  program 
"PFEVAL".) 

(10)  The  filter  design  is  not  repeated,  nor  ace  any 
of  the  other  designs.  Upon  terminating  execution,  the  PI 
gains  determined  previously  are  written  to  the  SAVE  file. 

The  command  "FILES"  gives  a  listing  of  existing  files.  Note 
that  files  SAVE,  LIST  and  PLOT  have  been  generated 


-V 


automatically  during  program  execution.  The  SAVE  file 
(containing  the  design,  truth,  and  command  model  data  as 
well  as  the  PI  gains  GC1  and  GC2,  and  the  Kalman  filter 
performance  data)  is  then  cataloged  for  future  use  (as  a 
DATA  file).  The  just-created  SAVE  file  is  then  copied  to 
the  local  file  named  DATA.  Next,  the  LIST  file  is  sent  to  a 
line  printer  for  listing.  Finally,  the  SAVE  file  is 
returned,  making  re-execution  of  the  program  feasible  (since 
SAVE  had  been  made  a  permanent  file,  it  could  not  be  written 
to  in  subsequent  executions).  In  a  subsequent  execution, 
the  various  dynamics  models  and  the  PI  gains  would  be 
available  from  the  new  DATA  file  and  a  new  SAVE  file  would 
be  created  (if  desired).  (Note:  The  required  parameters  to 
run  the  evaluation  program  "PFEVAL"  are  also  written  to  the 
SAVE  file.)  However,  in  this  case  there  is  no  repeated 
execution  of  the  program,  and  the  user  enters  a  "LOGOUT" 
from  the  system. 


z(ti)  =  [1  0]x(ti)  +  [0  lln^tti)  +  v(ti) 

R  -  .1 

Truth  Model 


Command  Model 

Sm'l>  +r°]Vt> 

Xm(t)  -  UO  +  Illicit) 


(1) 

DATE  11/09/83 
TIME  21.25.21. 

PLEASE  LOGIN 
LOGIN, T830287 

XXXXXXXXXX  ENTER  PASSWORD- 


11/09/83  LOGGED  IN  AT  21. 26.08. 

WITH  USER-ID  X3 
EQUIP/PORT  14/021 

LOGIN  CREATED  11/09/83  TODAY  IS  11/09/83 

COMMAND-  BEGIN, CLASS,, MACM,JPM 

COMMAND-  CONNECT, INPUT, OUTPUT 

COMMAND-  GET, CGTPIQ, IDsMACM 

FILE  NAME  CGTPIQ  HAS  BEEN  RETRIEVED 
COMMAND-  REQUEST, SAVE, »PF 

COMMAND-  CGTPIQ 


(2) 


*  *  •  CGTPIQ  »  »  * 

PROGRAM  TO  DESIGN  A  COMMAND  GENERATOR  TRACKER 
USING  A  REGULATOR  WITH  PROPORTIONAL  PLUS  INTEGRAL  CONTROL 
BASED  ON  THE  INTEGRAL  OF  THE  REGULATION  ERROR, 

AND  A  KALMAN  FILTER  FOR  STATE  ESTIMATION. 

•  •  •  CGTPIQ  *  »  » 

DATE  :  11/09/83 

TIME  :  21.28.36. 

ENTER  SAMPLE  PERIOD  FOR  DIGITAL  CONTROLLER  >.02 

READ  DESIGN  MODEL  FROM  ’DATA’  FILE  (Y  OR  N)  >N 

ENTER  DESIGN  MODEL  FROM  TERMINAL  (Y  OR  N)  >Y 

ENTER  N  >2 

ENTER  R  >1 

ENTER  P  >1 

ENTER  M  >1 

ENTER  D  >2 

ENTER  W  >1 

ENTER  WD  >1 


ENTER  A 

ENTER  I,J  AND  M(I,J)~ (0/  WHEN  COMPLETE)  :  2  BY  2  >1  1  -2 

1  2  5 

2  1  -5 
2  2-2 
0/ 


ENTER  B 

ENTER  I,J  AND  M(I,J)~ (0/  WHEN  COMPLETE)  :  2  BY  1  >2  1  1 

0/ 


ENTER  EX 

ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  2  BY  2  >1  1  3 

1  2  -1 
2  1  1 
2  2  5 
0/ 


ENTER  G 

ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  2  BY  1  >1  1  .1 

2  1  .1 

0/ 


ENTER  Q 

ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  1  BY  1  >1  1  1 

0/ 


ENTER  C 

ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  1  BY  2  >1  1  1 

0/ 


ENTER  DY 

ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  1  BY  1  >1  1  1 

0/ 


ENTER  EY 

ENTER  I,J  AND  M(I,J)~ (0/  WHEN  COMPLETE)  :  1  BY  2  >1  1  1 

1  2  1 
0/ 


ENTER  H 

ENTER  I,J  AND  M(I,J)~ (0/  WHEN  COMPLETE)  :  1  BY  2  >1  1  1 

0/ 


2  >1  2  1 


1  >1  1  .1 


2  >1  1  1 


1  >1  1  .1 


1  >1  1  1 


'  .  '  k  *  ■  ’  m  ~  .  *  *  *  , 


(3) 

CONTROLLER  DESIGN  (Y  OR  N)  >Y 

-ft 

-»V-  DESIGN  REG/PI  (Y  OR  N)  >N 

DESIGN  CGT  (Y  OR  N)  >Y 

READ  REG/PI  GAINS  PROM  'DATA*  FILE  (Y  OR  N)  >N 
READ  COtMAND  MODEL  FROM  'DATA*  FILE  (Y  OR  N)  >N 
ENTER  COMMAND  MODEL  FROM  TERMINAL  (Y  OR  N)  >Y 
ENTER  NM  >2 
ENTER  RM  >1 
ENTER  PM  >1 


ENTER  AM 

ENTER  I,J  AND  M(I,J)~ (0/  WHEN  COMPLETE)  :  2  BY  2  >1  1  -5 

1  2  5 

2  1  -5 
2  2-5 
0/ 


ENTER  BM 

ENTER  I,J  AND  M(I, J)— (0/  WHEN  COMPLETE)  :  2  BY  1  >2  1  1 

0/ 


ENTER  CM 

ENTER  I,J  AND  M(I,J)~ (0/  WHEN  COMPLETE)  ;  1  BY  2  >1  1  10 

0/ 


^  VM’V.li  .V  A  ,'.’V.,.,A- r.'.’rN''..'..''.r.'.'\rA-  ■. !;v 


GP 


(4) 

KXM  MATRIX 

33.44  -13.57 

KXU  MATRIX 
-.2812 
KXN  MATRIX 

-1.131  -1.484 

CONTROLLER  EVALUATION  WRT  TRUTH  MODEL  (Y  OR  N)  >Y 

READ  TRUTH  MODEL  FROM  'DATA*  FILE  (Y  OR  N)  >N 

ENTER  TRUTH  MODEL  FROM  TERMINAL  (Y  OR  N)  >Y 

ENTER  NT  >4 

ENTER  RT  >1 

ENTER  MT  >1 

ENTER  WT  >1 

ENTER  AT 


W 

ENTER  I.J 

1  2 

5 

% 

1  3 

3 

1  4 

-1  • 

i 

2  1 

-5 

1 

2  2 

-2 

ft 

2  3 

1 

2  4 

5 

£ 

Sc. 

i 

0/ 

ENTER  BT 

ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  4  BY  1 

0/ 


ENTER  GT 

ENTER  I,J  AND  M(I,J)~(0/  WHEN  COMPLETE)  :  4  BY  1 

2  1  .1 

0/ 


& 

>> 


ENTER  QT 

ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  1  BY  1 

0/ 
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i 


>1  1  -2 


>2  1  1 


>1  1  .1 


>1  1  1 


1  BY  4  >1  1  1 


•-I 

N  ' 

ENTER 

ti 

ENTER 

N 

1  4  1 
0/ 

ENTER 

ENTER 

0/ 

J 

ENTER 
ENTER 
2  2  1 
0/ 

ENTER 

ENTER 

*• 

< 

2  4  1 

0/ 

2  BY 


MODIFY  MATRIX  ELEMENTS  (Y  OR  N)  >N 


II' 


0 


WRITE  TROTH  MODEL  TO  'SAVE*  FILE  (Y  OR  N)  >Y 
TROTH  MODEL  WRITTEN  TO  ’SAVE*  FILE 


-'X 


POLES  OF  TROTH  MATRIX 


-2 . OOOOOOOE+OO 
-2. OOOOOOOE+OO 
0. 

0. 


+J(  5. OOOOOOOE+OO) 
+J(  -5. OOOOOOOE+OO) 
+J(  0.  ) 
+J(  0.  ) 


1  >1  1  .1 


4  >1  1  1 


4  >1  3  1 


B-74 


ENTER  MODEL  INPUT  AND  STEP  VALUE  :  1  >1  1 
ENTER  STATE  AND  IC  VALUE  (0/  TERMINATES):  4  >0/ 

2  PLOTS  OF  5  VARIABLES  MAY  BE  PRINTED  AT  THE  TERMINAL  —  SPECIFY  NUMBER 
FOR  EACH  <N1,N2)  >2  0 

ENTER  OUTPUTS  BY  TYPE  AND  INDEX  IN  2  ENTRIES— TYPES  ARE 
STATE  :  ’X’ 

OUTPUT  :  * Y* 

INPUT  :  *U» 

MODEL  :  »M» 

PLOT  1 
OUTPUT  1  >T 

>1 

OUTPUT  2  >M 
>1 

ENTER  TIME  DURATION  FOR  RESPONSE,  IN  SECONDS  >1 

♦ -  ENTER  TITLE  IN  GIVEN  FIELD  - - 

SIMPLE  DESIGN  TEST  OF  CGT 


(6) 

MORE  TIME  RESPONSE  RUNS  (Y  OR  N)  >N 
CONTROLLER  DESIGN  (Y  OR  N)  >Y 
DESIGN  REG/PI  (Y  OR  N)  >Y 
INCORPORATE  IMPLICIT  MODEL  (Y  OR  N)  >Y 
MODIFY  COMMAND  MODEL  (Y  OR  N)  >N 

COMMAND  MODEL  STATE  DIM  MUST  EQUAL  SYSTEM  OUTPUT  DIM 

CONTROLLER  DESIGN  (Y  OR  N)  >Y 

DESIGN  REG/PI  (Y  OR  N)  >Y 

INCORPORATE  IMPLICIT  MODEL  (Y  OR  N)  >N 

ENTER  HEIGHTS  ON  OUTPUT  DEVIATIONS:  1 
ENTER  I  AND  QH(I,I)~(0/  WHEN  COMPLETE)  >1  5 
0/ 

ENTER  HEIGHTS  ON  INTEGRAL  OF  REGULATION  ERROR:  1 
ENTER  I  AND  QH(I,I)— (0/  HHEN  COMPLETE)  >1  20 
0/ 

ENTER  HEIGHTS  ON  CONTROL  MAGNITUDES:  1 
ENTER  I  AND  Qtf(I,I)— (0/  HHEN  COMPLETE)  >1  1 
0/ 


Y  MATRIX 

5.000 

UQ  MATRIX 

20.00 

MODIFY  ELEMENTS  OF  'X'  MATRIX  (Y  OR  N)  >Y 
LIST  *X»  MATRIX  TO  TERMINAL  (Y  OR  N)  >Y 
X  MATRIX 

5.000  0.  0. 

0.  0.  0. 

0.  0.  20.00 

ENTER  I,J  AND  M(I,J)— (0/  HHEN  COMPLETE)  :  3  BY  3  >2  2  10 

0/ 


* '.  ■  V  ■VWTTT'*^ 

s 
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(7) 

UM  MATRIX 
1.000 
GC1  MATRIX 

1.006  4.9054E-02 

GC2  MATRIX 
1.381 

CONTROLLER  EVALUATION  WRT  TRUTH  MODEL  (Y  OR  N)  >Y 

MODIFY  TRUTH  MODEL  (Y  OR  N)  >N 

POLES  OF  REGPI  MATRIX 

-1.9740188E+00  +J(  5.4833537E+00) 

-1.9740188E+00  +J(  -5.4833537E+00) 

-4.8082993E+01  +J(  1 .5707963E+02) 

ENTER  STATE  AND  IC  VALUE  (0/  TERMINATES):  4  >1  1 
2  1 
0/ 

2  PLOTS  OF  5  VARIABLES  MAY  BE  PRINTED  AT  THE  TERMINAL  —  SPECIFY  NUMBER 
FOR  EACH  (N1,N2)  >3  0 

ENTER  OUTPUTS  BY  TYPE  AND  INDEX  IN  2  ENTRIES— TYPES  ARE 
STATE  :  ’X* 

OUTPUT  J  »Y» 

INPUT  :  *U’ 

PLOT  1 
OUTPUT  1  >X 

>2 

OUTPUT  2  >Y 
>1 

OUTPUT  3  >U 
>1 

ENTER  TIME  DURATION  FOR  RESPONSE,  IN  SECONDS  >1 

+- - ENTER  TITLE  IN  GIVEN  FIELD - - 

SIMPLE  DESIGN  TEST,  PI 
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SIMPLE  DESIGN  TEST,  PI 
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MORE  TIME  RESPONSE  RONS  (Y  OR  N)  >N 
CONTROLLER  DESIGN  (Y  OR  N)  >Y 
DESIGN  REG/PI  (Y  OR  N)  >N 
DESIGN  CGT  (Y  OR  N)  >Y 
MODIFY  COMMAND  MODEL  (Y  OR  N)  >N 
KXM  MATRIX 

3.312 


11.61 

KXU  MATRIX 
-4.361 
KXN  MATRIX 
-1.653 


-1.380 

CONTROLLER  EVALUATION  WRT  TRUTH  MODEL  (Y  OR  N)  >Y 
MODIFY  TROTH  MODEL  (Y  OR  N)  >N 
ENTER  MODEL  INPUT  AND  STEP  VALUE  :  1  >1  1 
ENTER  STATE  AND  IC  VALUE  (0/  TERMINATES):  4  >0/ 


2  PLOTS  OF  5  VARIABLES  MAY  BE  PRINTED  AT  THE  TERMINAL  —  SPECIFY  NUMBER 
FOR  BACH  (N1,N2)  >2  0 


ENTER  OUTPUTS  BY  TYPE  AND  INDEX  IN  2  ENTRIES— TYPES  ARE 
STATE  :  »X» 

OUTPUT  :  »Y» 

INPUT  J  ‘U* 

MODEL  :  *M» 


PLOT  1 
OUTPUT  1  >Y 


>1 

OUTPUT  2  >M 
>1 

ENTER  TIME  DURATION  FOR  RESPONSE,  IN  SECONDS  >1 


- - ENTER  TITLE  IN  GIVEN  FIELD 

SIMPLE  DESIGN  TEST,  CGT/PI 


B-80 


(9) 

MORE  TIME  RESPONSE  RUNS  (Y  OR  N)  >N 
CONTROLLER  DESIGN  (Y  OR  N)  >N 
FILTER  DESIGN  (Y  OR  N)  >Y 
Q  MATRIX 
1.000 

QN  MATRIX 

1.000 

R  MATRIX 

.1000 

KF  MATRIX 

6.3304E-02 

4.9510E-02 

7.4844E-02 

7.4844E-02 

MODIFY  TRUTH  MODEL  (Y  OR  N)  >N 

POLES  OF  FILTER  MATRIX 

-2.5838398E+00  +J(  5.4568219E+00) 

-2.5838398E+00  +J(  -5.4568219E+00) 


-4.2659165E+00  +J(  0.  ) 

-4.2632564E-12  +J(  0.  ) 

- -  ENTER  TITLE  IN  GIVEN  FIELD  - ♦ 

SIMPLE  DESIGN  TEST,  KALMAN  FILTER 


FINAL  RMS  ERRORS  :  TRUE  s  6.3143454E-02 
(STATE  1)  COMPUTED  =  6.7931977E-02 

FINAL  RMS  ERRORS  :  TRUE  s  5.0726138E-02 
(STATE  2)  COMPUTED  =  5.9937274E-02 

FINAL  RMS  ERRORS  :  TRUE  s  5 .8594898E-02 

(STATE  3)  COMPUTED  =  7.7160159E-02 

FINAL  RMS  ERRORS  :  TRUE  =  S.SSg^SgSE-OE 
(STATE  4)  COMPUTED  s  7.7160159E-02 

WRITE  PERFORMANCE  EVALUATION  DATA  TO  ’SAVE'  FILE  (Y  OR  N)>Y 

PERFORMANCE  EVALUATION  DATA,  NO.  1, WRITTEN  TO  'SAVE  '  FILE 

CONTROLLER  DESIGN  (Y  OR  N)  >N 


(10) 

FILTER  DESIGN  (Y  OR  N)  >N 

END  DESIGN  RUNS  (Y  OR  N)  >Y 

REG/PI  GAINS  WRITTEN  TO  'SAVE*  FILE 

PROGRAM  EXECUTION  STOP 
STOP 

065400  MAXIMUM  EXECUTION  FL. 

5.323  CP  SECONDS  EXECUTION  TIME. 

COMMAND-  FILES 

—LOCAL  PILES— 

♦OUTPUT  PLOT  $INPUT  CGTPIQ  SAVE 

LIST  DATA 

COWUND-  CATALOG ,  SAVE ,  DATA 

INITIAL  CATALOG 
RP  s  008  DAYS 
CT  IDs  T830287  PFNsDATA 
CT  CYs  001  SNsAFIT  0000000576  WORDS. 
COMMAND-  RETURN, DATA 

COMMAND-  COPYBF, SAVE, DATA 

COMMAND-  RT,LIST 

LIST  SENT  TO  PRINTER (  AF  )  WITH  JPM. 
COMMAND-  RETURN, SAVE, PLOT, LIST, DATA 
COMMAND-  LOGOUT 

CPA  6.471  SEC.  5.273  ADJ. 

10  79.214  SEC.  23.447  ADJ. 

CRUS  34.486 

CONNECT  TIME  0  HRS.  40  MIN. 

11/09/83  LOGGED  OUT  AT  22.06.48. 

< 


B.13  CGTPIQ  Output  to  LIST  File 

The  first  output  is  a  heading  with  date  and  time 
identical  to  that  printed  at  the  terminal.  Next  the  sample 
period  of  the  controller  is  identified.  A  series  of  outputs 
related  to  the  design  model  then  follow;  these  are 
identified  by  a  heading  "DESIGN  MODEL".  First  the  matrices 
defining  the  continuous- time  representation  are  printed, 
then  the  matrices  of  the  discrete-time  representation  are 
printed.  An  additional  output  is  the  matrix  Pi  under  a 
heading  of  "CONTROLLER  SETUP". 

Output  relating  to  the  design  of  the  PI  controller 
is  identified  by  a  heading  of  "REG/PI  DESIGN".  The 
quadratic  weighting  matrices  are  printed  (y,  UQ,  X  and  UM) , 
followed  by  the  controller  gain  solution  GCS.  Finally,  the 
individual  PI  gains  GCl  and  GC2  are  printed,  as  well  as  the 
intermediate  product  E.  The  proportional  KP  and  integral  KI 
gains  are  then  printed.  (Note,  if  implicit  model  following 
is  requested,  there  are  the  additional  outputs  as  discussed 
in  Section  B.8.5  of  this  guide.) 

The  truth  model  description  is  identified  by  the 
heading  "TRUTH  MODEL".  The  matrices  of  the  continuous-time 
system  are  listed  first.  The  eigenvalues  of  the  matrix 
Afc  are  then  printed.  The  matrices  of  the  discrete-time 
representation  are  then  listed. 

Outputs  due  to  the  PI  controller  evaluation  routines 
are  identified  by  a  heading  of  "CONTROLLER  EVALUATION"  and 
begin  with  the  mapped  eigenvalues  of  the  closed- loop  system 
with  PI  controller.  The  time-response  plots  are  then  output 


with  each  plot  labeled  with  the  title  specified  by  the  user. 
The  plots  run  from  0  to  2  seconds  at  the  controller  sample 
period  specified  by  the  user  (maximum  101  character 
positions) . 

The  CGT/PI  design  path  begins  with  definition  of  the 
command  model,  with  relevant  output  identified  by  the 
heading  "COMMAND  MODEL".  The  continuous-time  system 
matrices  are  printed,  follow  by  the  eigenvalues  of  the 

matrix  A  •  The  discrete-time  matrices  are  then  printed. 

— m 

Output  due  to  the  CGT  design  computations  is  identified  by 
the  heading  "CGT  DESIGN".  The  matrices  are  then 
printed  followed  by  the  CGT/PI  control  gain  matrices  KXM, 

KXU  and  KXN. 

The  evaluation  of  the  CGT/PI  controller  is  also 
identified  by  the  header  "CONTROLLER  EVALUATION".  The 
closed- loop  CGT/PI  time  response  plots  are  then  printed. 

Output  due  to  the  Kalman  filter  design  routine  is 
identified  by  the  heading  "FILTER  DESIGN",  and  includes  the 
noise  strength  matrices  £  and  R  and  the  Kalman  filter  gain 
matrix  The  output  of  the  filter  evaluation  routines 

is  identified  by  the  heading  "FILTER  EVALUATION".  First, 
the  mapped  poles  of  the  filter  system  matrix  are  printed. 
During  the  covariance  analysis,  the  full  error  covariance 
matrix  is  printed  at  each  time  sample.  Finally,  the  plots 
are  printed:  each  plot  includes  the  standard  deviations  of 
the  "true"  and  filter-computed  estimation  error  for  each 
design  model  state  for  50  consecutive  time  samples  taken  at 
the  controller/filter  sample  period. 


B.14 


Summary 


Appendix  B  has  given  the  user  of  the  program  CGTPIQ 
an  in-depth  look  at  the  operations  of  the  program.  This 
appendix  was  written  to  be  a  stand-alone  document  for  normal 
program  operation  and  hopefully  has  met  that  goal. 
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The  following  program  listing  includes  all  routines 
of  CGTPIQ.  Routines  of  the  'LIBRARY'  object  file  are  not 
listed  (Ref  13) . 

CGTPIQ  is  composed  of  three  parts:  a  'MAIN'  routine, 
an  optional  set  of  user-provided  routines,  and  a  large  set 
of  invariant  routines  referred  to  as  'CGTPIQ  SUBS'.  In  this 
listing,  routines  'DSND ' ,  'DSNM' ,  1 TRTHD ' ,  ' TRTHM ' , 

' ACDATA ' ,  'GUSTS',  and  'TBLUP1'  are  the  optional  routines. 
These  optional  routines  are  used  to  establish  the  design 
model  AFTI (S3 ,A2 ,G3)  for  the  pitch-pointing  controller,  and 
the  truth  model  AFTI (S4 ,A2 ,G3) ,  both  as  described  in  Chapter 
VI  of  Floyd's  thesis  (Ref  9). 

Included  at  the  end  of  this  main  listing  are 
listings  of  the  subroutines  that  were  changed  for  each  of 
the  CGT/PI  formulations  2,  3  and  4  (See  Section  3.3.2). 


100a  PROGRAM  MAIN ( INPUTa64 , OUTPUTr 64 , LISTa64 , 

110r  1  SAVE* 64 , D AT Aa  64 , PLOT  a  64 , 

120a  1  TAPE5aINPUT,TAPE6aOUTPUT,TAPE25aSAVE,TAPE50aDATA, 

130a  2  TAPE99sPLOT,TAPEl6aLIST) 

11»0a  C0MM0N/MAIN1  /NDIM,  NDIM1 ,C0M1  (400) 

150a  C0MM0N/MAIN2/C0M2 ( 400 ) 

160a  COMMON/INOU/KIN,KOUT,KPUNCH 

1 70a  COMMON/FILES/KSAVE, KDATA , KPLOT, KLIST, KTERM 

180a  COMMON/SYSMTX/NVSM, SM( 2 1 25 ) 

190a  C0MM0N/ZMTX1 /NVZM, ZM1 ( 1 225 ) 

200a  COMMON/ZMTX2/ZM2 (1225) 

2 1 Oa  COMMON/DSNMTX/NVDM, NOD Y, NOEY, DM( 1 750 ) 

220a  COMMON/CMDMTX/NVCM, NEWCM, NODC , CM( 225 ) 

230a  COMMON/TROMTX/NVTM, TM( 1 725 ) 

240a  COMMON/CONTROL/NVCTL , CTL ( 900 ) 

250a  COMMON/CREGPI/NVRPI,RPI(675) 

260a  COMMON/CCGT/NVCGT , CGT ( 400 ) 

270a  COMMON/CKF/NVFLT,FLT(690) 

280a  COMMON/AMC/AM(100) 

290a  COMMON/BDG/BD ( 75 ) 

300a  NDIMa400 

310a  NVSM=2125 

320a  NVZM*1225 

330a  NVDM= 1 750 

340a  NVCMa225 

350a  NVTMa 1 725 

360a  NVCTL=900 

370a  NVRPI=675 

380a  NVCGT=400 

390a  NVFLTa690 

400a  KINa5 

410a  KSAVEa25 

420a  KDATAa50 

430a  KPLOTa99 

440a  KLISTal6 

450a  KTERM=6 

460a  CALL  CGTXQ 

470a  STOP 

480aC  END  MAIN 
490a  END 

500a  SUBROUTINE  DSND(ND) 

510a  DIMENSION  ND(1) 

520a  ND(1)a8 

530a  ND(2)a2 

540a  ND(3)*2 

550a  ND(4)a3 

560a  ND(5)aO 

570a  ND(6)a1 

580a  ND(7)=0 

590a  RETURN 

600aC  END  SUBROUTINE  DSND 

610a  END 

620a  SUBROUTINE  DSNM(A,B,EX,G,Q,C,DX,EY,H,HN,R,AN,GN,QN) 

630a  DIMENSION  A(8,8),B(8,2),C(2,8),G(8),DY(2,2),H(3,8M(3,3) 


640=  DATA  GRAVTY,DEGTRD, PI/32. 174, .01745329, 3. 1415927/ 

650=  CALL  ACDATA( LEVEL, VT, ALT, ALPHA, ZA,ZAD,ZQ,ZU,ZDE,ZDF, 

660=  1  PMA,PMAD,PMQ,PMU,PMDE, PMDF,XA, XAD,XQ, XU, XDE, XDF, 

670=  2  TE,DLX,BSPAN) 

680=  10  ALPHAR=DEGTRD*ALPHA 
690=  U0=VT*C0S (ALPHAR ) 

700=  WO=VT»SIN( ALPHAR) 

710=  A(1,3)=1. 

720=  A(2, 1)=-GRAVTY*SIN(ALPHAR)/U0 

730=  A(2,2)=ZA 

740=  A(2,3)=1 .+ZQ 

750=  A(3,2)=PMA 

760=  A(3,3)=PMQ 

770=  A(2,7)=ZA 

780=  A(2,8)=ZQ 

790=  A(3,7)=PMA 

800=  A(3,8)=PMQ 

810=  A(2,4)=ZDE 

820=  A(2,5)=ZDF 

830=  A(3,4)=PMDE 

840=  A(3,5)=PMDF 

850=  A(4,4 )=-TE 

860=  A(5,5)=-TE 

870=  B(4, 1 )=TE 

880=  B(5,2)=TE 

890=  CALL  GUSTS (LEVEL , ALT , SLU , SLW , SIGU , SIGW) 

900=  A(6,6)=-VT/SLH 

910=  A(7,6)=(1.-SQRT(3.))*SIGH»SQRT(-A(6,6))/SLW 

920=  A(7,7)=A(6,6) 

930=  A(8,8)=-VT*PI/4./BSPAN 

940=  A(8,6)=-A(8,8)*A(7, 6) 

950=  A(8,7)=-A(8,8)*A(7»7) 

960=  G(6)=1 . 

970=  G( 7 ) =SIGW*SQRT ( 3 •* VT/SLH) /VT 

980=  G(8)=-A(8,8)»G(7) 

990=  Q=1 . 

1000=  C(1,1)=1. 

1010=  C(2, 1 )=1 . 

1020*  C(2,2)=-1. 

1030=  H( 1 , 1 )=1 • 

1040=  H(2,2)*1. 

1050*  H(3»3)=1 • 

1060=  H(2,7)=1. 

1070*  R(1,1)=4.76E-6 

1080=  R(2,2)=1 .22E-5 

1090=  R(3,3)*3.22E-5 

1 100=  RETURN 

1110=C  END  SUBROUTINE  DSNM 
1120=  END 

1130=  SUBROUTINE  TRTHD(ND) 

1140=  DIMENSION  ND(1) 

1150=  ND( 1 )=9 

1160=  ND(2)=2 

1170*  ND(3)=3 

1180=  ND(4)=1 


1190=  RETURN 

1200=C  END  SUBROUTINE  TRTHD 

1210=  END 

1220=  SUBROUTINE  TRTHM( AT , BT , GT , QT , HT , RT , TDT ,  TNT ) 

1230=  DIMENSION  AT(9,9)#BT(9,2),GT(9),HT(3,9),RT(3,3),TDT(8,9) 

1240=  DATA  GRAVTY,DEGTRD, PI/32. 174, .01745329, 3. 1415927/ 

1250=  CALL  ACDATA( LEVEL, VT, ALT, ALPHA, ZA,ZAD,ZQ,ZU,ZDE,ZDF, 

1260=  1  PMA,PMAD,PMQ,PMU,PMDE,PMDF,XA,XAD,XQ,XU,XDE,XDF, 

1270=  2  TE,DLX,BSPAN) 

1280=  10  ALPHARsDEGTRD* ALPHA 
1290=  UO=VT*COS (ALPHAR ) 

1300=  WO*VT»SIN( ALPHAR) 

1310=  RZAD=1 ./( 1 .-ZAD) 

1320=  AT(1,3)=1. 

1330=  AT(2, 1 ) =-GRAVTY*S I N ( ALPHAR ) /UO 

1340=  AT(2,2)=ZA 

1350=  AT(2,3)=1.+ZQ 

1360=  AT(2,4)=ZU 

1370=  AT(3,2)=PMA 

1380=  AT(3,3)=PMQ 

1390=  AT(3,4)=PMU 

1400=  AT(4,1)=-GRAVTY«C0S( ALPHAR) 

1410=  AT(4,2)=XA 

1420=  AT(4,3)=XQ-W0 

1430=  AT(4,4)=XU 

1440=  AT(2,5)=ZDE 

1450=  AT(2,6)=ZDF 

1460=  AT(3,5)=PMDE 

1470=  AT(3,6)=PMDF 

1480=  AT(4,5)=XDE 

1490=  AT(4,6)=XDF 

1500=  AT(5,5)=-TE 

1510=  AT(6,6)*-TE 

1520=  AT(2,8)=ZA 

1530=  AT(2,9)=ZQ 

1540=  AT(3,8)=PMA 

1550=  AT(3,9)*PMQ 

1560=  AT(4,8)=XA 

1570=  AT(4,9)=XQ 

1580=  CALL  GUSTS (LEVEL , ALT , SLU , SLW , SIGU , SIGN ) 

1590=  AT(7,7)=-VT/SLW 

1600=  AT ( 8 , 7 ) = ( 1 . -SQRT ( 3 . ) ) »SIGW»SQRT ( -AT ( 7, 7 ) ) /SLW 

1610=  AT(8,8)=AT<7,7) 

1620=  AT ( 9 » 9 ) =-VT*PI/4 • /BSPAN 

1630=  AT(9»7)=-AT(9»9)§AT(8,7) 

1640=  AT(9»8)=-AT(9,9)*AT(8,8) 

1650=  GT(7)=1 * 

1660=  GT ( 8 ) « SIGW*SQRT ( 3 . • VT/SLW) /VT 

1670.  GT(9)=-AT(9,9)«GT(8) 

1680=  QTsI . 

1690=  DO  20  1=1,9 

1700=  AT(2,I)=AT(2,I)*RZAD 

1710=  AT(3,I)=AT(3,I)+PMAD«AT(2,I) 

1720=  20  AT(4,I).AT(4,I)+XAD»AT(2,I) 

1730=  BT(5# 1 )=TE 


1740s  BT(6,2)sTE 

1750s  HT( 1 , 1 )=1 . 

1760s  HT ( 2 , 2 ) = 1 . 

1770s  HT(3,3)s1 . 

1780s  HT ( 2 , 8 ) = 1 . 

1790s  RT(1,1)*4.76E-6 

1800s  RT(2,2)s1.22E-5 

1810s  RT(3,3)*3.22E-5 

1820s  TDT(1,1)s1. 

1830s  TDT(2,2)s1 . 

1840s  TDT(3»3)S1 • 

1850s  TDT(4,5)*1. 

1860s  TDT(5#6)s1 . 

1870s  TDT(6,7)*1. 

1880s  TDT(7,8)s1. 

1890s  TDT(8,9)=1. 

1900s  RETURN 

1910sC  END  SUBROUTINE  TRTHM 

1920s  END 

1930s  SUBROUTINE  ACDATA ( LEVEL , VT , ALT , ALPHA ,  ZA  , ZAD , ZQ , ZU , ZDE , ZDF , 

1940s  1  PMA, PMAD, PMQ, PMU, PMDE, PMDF, XA,XAD,XQ» XU, XDE,XDF, 

1950s  2  TE,DLX,BSPAN) 

1 960s  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

1970s  DATA  NENTRY/1/ 

1980s  5  WRITE  101 
1990s  READ* , LEVEL 

2000s  IF( (LEVEL. GT. 3) «0R. (LEVEL.LT. 1 ) )  GO  TO  5 

2010s  WRITE  102 

2020s  READ*, VT.ALT, ALPHA 

2030s  WRITE  103 

2040s  READ*, ZA, ZAD, ZQ,ZU, ZDE, ZDF 

2050s  WRITE  104 

2060s  READ*, PMA, PMAD, PNQ, PMU, PMDE, PMDF 

2070s  WRITE  105 

2080s  READ*,XA,XAD,XQ,XU,XDE,XDF 

2090s  WRITE(KLIST, 101 ) 

2100s  WRITE (KLIST, 109)  LEVEL 

2110s  WRITE(KLIST, 102) 

2120s  WRITE(KLIST, 110)  VT, ALT, ALPHA 

2130s  WRITE(KLIST,103) 

2140s  WRITE( KLIST, 110)  ZA,ZAD,ZQ,ZU,ZDE,ZDF 

2150s  WRITE (KLIST, 104) 

2160s  WRITE (KLIST, 110)  PMA, PMAD, PMQ, PMU, PMDE, PMDF 

2170s  WRITE ( KLIST ,105) 

2180s  WRITE( KLIST, 110)  XA,XAD,XQ,XU,XDE,XDF 

2190s  IF(NENTRT.EQ.O)  GO  TO  10 

2200s  BSPANs30. 

2210s  DLXs13.798 

2220s  TEs20. 

2230s  RETURN 

2240s  10  WRITE  106 
2250s  READ*,TE 

2260s  WRITE  107 

2270s  READ*,DLX 

2280s  WRITE  108 
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2290*  READ*, BSP AN 

2300*  101  FORMAT ("  ENTER  TURBULENCE  LEVEL  (1,2,3)  >") 

2310*  102  FORMAT ("  ENTER  TRIM  VELOCITY,  ALTITUDE,  AND  ALPHA  >") 

2320*  103  FORMAT ("  ENTER  ZA,  ZAD,  ZQ,  ZU,  ZDE,  ZDF  >") 

2330*  104  FORMAT ("  ENTER  MA,  MAD,  MQ,  MU,  MDE,  MDF  >") 

2340*  105  FORMAT ("  ENTER  XA,  XAD,  XQ,  XU,  XDE,  XDF  >») 

2350*  106  FORMAT (»  ENTER  TIME  CONSTANT  FOR  ELEVATOR  >") 

2360*  107  FORMAT ("  ENTER  DISTANCE  FROM  CG  TO  ACCELEROMETER  >") 

2370*  108  FORMAT ("  ENTER  WING  SPAN  >”) 

2380*  109  F0RMAT(6X,I1 ) 

2390*  110  FORMAT(6(6X1PE15.7)) 

2400*  RETURN 

2410*C  END  SUBROUTINE  ACDATA 

2420*  END 

2430*  SUBROUTINE  GUSTS ( LEVEL , ALT , SLU , SLW , SIGU , SIGN) 

2440*  DIMENSION  ATRB1 (4 ) , ATRB2 (4 ) , ATRB3 (4 ) , SIGT1 (4 ) , SIGT2 (4 ) , SIGT3 (4 ) 
2450*  DATA  ATRB1/2000., 2750., 10000. ,30000./ 

2460*  DATA  ATRB2/2000., 2750., 10000., 45000./ 

2470*  DATA  ATRB3/2000., 5000., 20000., 70000./ 

2480*  DATA  SIGT1/4.5,5.,5.,0./ 

2490*  DATA  SIGT2/8.5, 10., 10. ,0./ 

2500*  DATA  SIGT3/12.,21 .,21 .,0./ 

2510*  DATA  IT1 ,IT2,IT3/1 ,1,1/ 

2520*  IF(ALT-1750.)  5,15,15 

2530*  5  IF (ALT- 1000.)  8,10,10 

2540*  8  ALTTsALT 

2550=  GO  TO  12 

2560=  10  ALTTslOOO. 

2570=  12  SIGW.2.5*FLOAT(LEVEL) 

2580*  SIGU* 1 . / ( . 1 77+8 . 23E-4  *ALTT ) •• . 4 

2590*  SLWsALTT 

2600*  SLU*ALTT»SIGU«3 

2610*  SIGU*SIGU*SIGW 

2620*  GO  TO  100 

2630*  15  SLU* 1750. 

2640*  SLW* 1750. 

2650*  IF (LEVEL-2)  17,18,16 

2660*  16  CALL  TBLUP1 ( ATRB3 , SIGT3 , 4 , IT3 , ALT , SIGU) 

2670*  GO  TO  19 

2680*  17  CALL  TBLUP1(ATRB1,SIGT1,4,IT1,ALT,SIGU) 

2690*  GO  TO  19 

2700*  18  CALL  TBLUP 1 ( ATRB2 , SIGT2 , 4 , IT2 , ALT , SIGU ) 

2710*  19  SIGWsSIGU 
2720*  100  RETURN 
2730*C  END  SUBROUTINE  GUSTS 

2740*  END 

2750*  SUBROUTINE  TBLUP1 (X,I,N,IXP,XP,YP) 

2760*  DIMENSION  X(1),Y(1) 

2770*  IF(IXP)  15,15,1 

2780*  1  IF(IXP-N)  10,10,5 

2790*  5  IXP*N 

2800*  GO  TO  18 

2810*  10  IF(XP-X(IXP))  12,18,20 

2820*  12  IXP*IXP-1 

2830*  IF(IXP)  15,15,10 
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2840s  15  IXPsI 

2850s  18  YPsY(IXP) 

2860s  RETURN 

2870s  20  IF(IXP-N)  21,18,5 

2880s  21  IXPPIsIXP+1 

2890s  22  IF(XP-X(IXPP1))  25,30,30 

2900s  25  YPsKIXPMXP-X(IXP) )/(X(IXPP1  )-X(IXP) )»(Y(IXPP1  )-Y(IXP) ) 

2910s  RETURN 

2920s  30  IXPsIXPPI 

2930s  GO  TO  20 

2940sC  END  SUBROUTINE  TBLUP1 

2950s  END 

2960s  SUBROUTINE  CGTXQ 

2970s  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

2980s  C0MM0N/MAIN2/C0M2 ( 1 ) 

2990s  COMMON/INOU/KIN, KOUT, KPUNCH 

3000s  COMMON/D ESIGN/NVCOM, TSAMP , LFLRPI, LFLCGT, LFLKF, LTEVAL, LABORT 

3010s  COMMON/FILES/KSAVE, KDATA, KPLOT, XL 1ST, KTERM 

3020s  C0M10N/SYSMTX/NVSM, SM( 1 ) 

3030s  C0HM0N/ZMTX1 /NVZM, ZM1 ( 1 ) 

3040s  C0MM0N/ZMTX2/ZM2 ( 1 ) 

3050s  COMMON/ND IMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

3060s  COMMON/LOCD/LAP , LGP , LPHI, LBD, LEX, LPHD, LQ, LQN, LQD, LC , LDY, LEY, LHP , LR 

3070s  COMMON/DSNMTX/NVDM, NODY , NOE Y, DM( 1 ) 

3080=  COMMON/NDIMC/NNC,NRC,NPC 

3090s  COMMON/LOCC/LPHC , LBDC , LCC , LDC 

3 100s  COMKON/CMDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

3110=  COMMON/ND IMT/NNT, NRT, NMT , NWT 

3120=  COMMON/LOCT/LPHT , LBDT , LQDT , LHT , LRT , LTDT , LTNT 

3 1 30=  COMMON/TRUMTX/NVTM, TM( 1 ) 

3140=  COMMON/LCNTRL/LPI 1 1 , LPI1 2 , LPI2 1 , LPI22 , LPHDL, LBDL 

3150=  COMMON/CONTROL/NVCTL, CTL( 1 ) 

3 1 60=  COMMON/LREGPI/LXDW , LUDW, LPHCL , LGC 1 , LGC2 , LEL , LEE 

3170=  COMMON/CREGPI/NVRPI,RPI( 1 ) 

3 1 80=  COMMON/LCGT/LA 1 1 , LA 1 3 , LA2 1 , LA23 , LA 1 2 , LA22 , LELA 1 1 , LELA 1 2 , LELA 1 3 

3190=  COMMON/CCGT/NVCGT,CGT( 1 ) 

3200=  COMMON/LKF/LEADSN, LFLTRK , LFCOV 

3210=  COMMON/CKF/NVFLT,FLT( 1 ) 

3220=  C0MM0N/AMC/AM(1) 

3230s  COMMON/BDG/BD ( 1 ) 

3240s  DIMENSION  LD(15),ND(15) 

3250s  DATA  NPLTZM/606/ 

3260=  DATA  IE0I,N0/-1,1HN/ 

3,?70=  REWIND  KLIST 

3280=  WRITE(KLIST,115)  DATE(DUM) ,TIME(DUM) 

3290=  WRITE (KTERM, 115)  DATE(DUM) , TIME(DUM) 

3300=  115  F0RMAT("1",27X,"»  •  •  CGTPIQ  •  •  »"/14X, 

3310s  1  "PROGRAM  TO  DESIGN  A  COMMAND  GENERATOR  TRACKER" /8X, 

3320=  2  "USING  A  REGULATOR  WITH  PROPORTIONAL  PLUS  INTEGRAL  CONTROL" /13X, 

3330s  3  "BASED  ON  THE  INTEGRAL  OF  THE  REGULATION  ERROR, "/16X, 

3340=  4  "AND  A  KALMAN  FILTER  FOR  STATE  ESTIMATION. "/28X, 

3350s  5  "•  •  •  CGTPIQ  •  •  »"//11X,»DATE  :  ",A10//,11X, 

3360s  6  "TIME  :  ",A10////) 

3370s  REWIND  KSAVE 


3380a 

REWIND  KDATA 

3390= 

WRITE ( KSAVE, 1 12)  IE0I,NPLTZM 

3400= 

DO  10  1=1,15 

3410= 

10 

ND(I)=0 

3420= 

DO  12  1=1,15 

3430= 

12 

LD  ( I )  =  1 

3440= 

LFLRPIsO 

3450= 

LFLCGTsO 

3460= 

LPLKFsO 

3470= 

LTEVALsO 

3480= 

LABORT.O 

3490= 

IPIsO 

3500= 

ICGTsO 

3510= 

ITRUsO 

3520= 

IFLTRsO 

3530= 

IC0DE=4 

3540= 

LFAVALzO 

3550= 

LGCGTsO 

3560= 

NTCOMsMINO (NDIM, NVZM) 

3570= 

KOUTsKLIST 

3580= 

KPUNCHsKPLOT 

3590= 

IF(NVSM.GE.NPLTZM)  GO  TO  50 

3600= 

WRITE  101 , NPLTZM 

3610= 

GO  TO  1000 

3620= 

50 

WRITE  102 

3630= 

READ*,TSAMP 

3640= 

IF(TSAMP.LE.O.)  GO  TO  50 

3650= 

WRITE(KLIST,103)  TSAMP 

3660= 

103 

FORMAT ("OSAMPLE  PERIOD  IS  \F5.3," 

SECONDS") 

3670= 

CALL  SETUP (ND,LD,ICGT,ITRU, 1 ) 

3680= 

IF ( LABORT )  1000,100,1000 

3690= 

100 

LAB0RT=0 

3700= 

IMPLICsO 

3710= 

WRITE  104 

3720= 

104 

FORMAT ("OCONTROLLER  DESIGN  (Y  OR  N) 

>") 

3730= 

READ  111, IANS 

3740= 

IF(IANS.EQ.NO)  GO  TO  500 

3750= 

LFLKFsO 

3760= 

CALL  PIMTX(IPI) 

3770= 

IF (LABORT)  1000,125,1000 

3780= 

125 

WRITE  105 

3790* 

105 

FORMAT ( "ODESIGN  REG/PI  (Y  OR  N)  >") 

3800= 

READ  111, IANS 

3810= 

IF(IANS.EQ.NO)  GO  TO  150 

3820= 

WRITE  400 

3830= 

400 

FORMAT(”OINCORPORATE  IMPLICIT  MODEL 

(Y  OR  N)  >") 

3840= 

READ  111, IANS 

3850= 

IF(IANS.EQ.NO)  GO  TO  490 

3860= 

IMPLIC.1 

3870= 

CALL  SETUP(ND,LD,ICGT,ITRU,4) 

3880= 

IF(ICGT.NE.O)  GO  TO  460 

3890= 

IMPLICsO 

3900= 

GO  TO  480 

3910= 

460 

IF(NPD.EQ.NNC)  GO  TO  480 

3920. 

WRITE  470 

C-8 


3930s  470  FORMAT ("OCOMMAND  MODEL  STATE  DIM  MUST  EQUAL  SYSTEM  OUTPUT  DIM") 

3940s  LABORTs-1 

3950s  480  IF(LABORT)  100,490,1000 

3960s  490  CALL  SREGPI(IMPLIC) 

3970s  IF(LABORT)  1000,200,1000 

3980s  150  WRITE  106 

3990s  106  FORMAT ("ODESIGN  CGT  (Y  OR  N)  >") 

4000s  READ  111, IANS 

4010s  IF(IANS.EQ.NO)  GO  TO  100 

4020s  CALL  SETUP(ND,LD,ICGT,ITRU,2) 

4030s  IF(ICGT)  155,100,155 
4040s  155  IF(LABORT)  100,160,1000 
4050s  160  CALL  SCGT 
4060s  IF(LABORT)  100,170,1000 

4070s  170  IF(LFLCGT.LE.O)  GO  TO  125 
4080s  200  LABORTsO 
4090s  WRITE  107 

4100s  107  FORMAT ("OCONTROLLER  EVALUATION  WRT  TRUTH  MODEL  (Y  OR  N)  >") 

4110s  READ  111, IANS 

4120s  IF(IANS.EQ.NO)  GO  TO  250 

4130s  CALL  SETUP(ND,LD,ICGT,ITRU,3) 

4140s  IF(LABORT)  200,260,1000 

4150s  250  LTEVALsO 

4160s  260  CALL  CEVAL 

4170s  IF(LFLCGT.EQ.I)  LGCGTsI 

4180s  IF(LFAVAL.EQ.O.OR.LGCGT.EQ.O)  GO  TO  100 

4190=  270  WRITE  600 

4200=  600  FORMAT COWRITE  PERFORMANCE  EVALUATION  DATA  TO  ’SAVE*  FILE  (Y  OR  N) 
4210=  +>") 

4220=  READ  111, IANS 

4230=  IF (IANS.EQ.NO)  GO  TO  100 

4240=  IC0DE=IC0DE+1 

4250=  CALL  PFDATA(ICODE,ND) 

4260s  INUM=IC0DE-4 

4270=  WRITE  605,INUM 

4280=  605  FORMAT COPERFORMANCE  EVALUATION  DATA,  NO.  "12,", WRITTEN  TO  ’SAVE 
4290=  ♦’  FILE") 

4300=  GO  TO  100 
4310=  500  LABORTsO 
4320s  WRITE  108 

4330=  108  F0RMAT("0FILTER  DESIGN  (Y  OR  N)  >") 

4340=  READ  111, IANS 

4350=  IF (IANS.EQ.NO)  GO  TO  900 

4360=  CALL  FLTRK(IFLTR) 

4370=  IF(IFLTR.EQ.O)  GO  TO  900 
4380=  IF(LABORT)  1000,510,1000 
4390*  510  CALL  SETUP ( ND , LD , XCGT , ITRU , 3 ) 

4400=  IF(LABORT)  500,525,1000 

4410*  525  CALL  FEVAL 

4420*  530  IF(LABORT)  1000,540,1000 

4430*  540  LFAVALsI 

4440*  IF(LGCGT.EQ.I)  GO  TO  270 

4450*  GO  TO  500 

4460*  900  WRITE  109 

4470*  109  FORMAT ("OEND  DESIGN  RUNS  (Y  OR  N)  >") 


4480=  READ  111, IANS 

4490=  IF(IANS.EQ.NO)  GO  TO  100 

4500=  IF(LFLRPI.EQ.O)  GO  TO  1000 

4510=  NPNTS*  NRD* ( NNPR+NND ) 

4520=  ND( 1 )=NPNTS 

4530=  ND(2)=LGC1 

4540=  ND(3)=LGC2 

4550=  ND(4)=LEL 

4560=  CALL  WFILED(4,NPNTS,ND,RPI(LGC1)) 

4570=  WRITE  113 

4580=  1000  CONTINUE 

4590=  WRITE(KLIST, 110) 

4600=  REWIND  KSAVE 

4610=  REWIND  KDATA 

4620=  REWIND  KLIST 

4630=  WRITE  110 

4640=  101  FORMAT( "©INSUFFICIENT  MEMORY  /SYSMTX/,  NEED:  ",I4) 

4650=  102  FORMAT ("OENTER  SAMPLE  PERIOD  FOR  DIGITAL  CONTROLLER  >") 

4660=  110  FORMAT ( "OPROGRAM  EXECUTION  STOP") 

4670=  111  FORMAT (A3) 

4680=  112  FORMAT (214) 

4690=  113  F0RMAT(6X, "REG/PI  GAINS  WRITTEN  TO  ’SAVE*  FILE") 

4700=  RETURN 

471 0=C  END  SUBROUTINE  CGTXQ 

4720=  END 

4730=  SUBROUTINE  SETUP(ND,LD,ICGT,ITRU,ITYPE) 

4740=  DIMENSION  ND(1),LD(1) 

4750=  GO  TO  (10,15,20,15)  ITYPE 

4760=  10  CALL  SDSN(ND,LD) 

4770=  RETURN 

4780=  15  CALL  SCMD(ND,LD,ICGT, ITYPE) 

4790=  RETURN 

4800=  20  CALL  STRTH ( ND , LD , ITR U ) 

4810=  RETURN 

4820=C  END  SUBROUTINE  SETUP 

4830=  END 

4840=  SUBROUTINE  SDSN(ND,LD) 

4  850=  COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT, LFLKF , LTEVAL , LABORT 

4860=  COMMON/SYSMTX/NVSM, SM( 1 ) 

4870=  C0MM0N/ZMTX1 /NVZM, ZM1 ( 1 ) 

4880=  C0MM0N/ZMTX2/ZM2 ( 1 ) 

4  890=  COMMON/NDIMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

4900=  DIMENSION  ND(1),LD(1) 

4910=  NSIZEsO 

4920=  CALL  RSYS(SM,LD,ND,1,NSIZE) 

4930=  IF ( LABORT. GT.O)  RETURN 

4940=  NSIZEsNNPR 

4950=  IF ( NPLD • GT • NSIZE )  NSIZEsNPLD 

4960=  NSIZE=NSIZE*NSIZE 

4970=  IF(NSIZE.LE.NVCOM)  GO  TO  5 

4980=  WRITE  101, NSIZE 

4990=  101  FORMAT("OINSUFFICIENT  MEMORY  /MAIN1/,/MAIN2/,/ZMTX1/,/ZMTX2/,  NEED 
5000=  1:  ",I4) 

5010=  LABORTsNSIZE 

5020*  RETURN 
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5030=  5  IF(NRD.EQ.NPD)  GO  TO  10 

5040=  WRITE  102 

5050=  102  FORMAT ( "ONUMBER  OF  INPUTS  AND  OUTPUTS  MUST  BE  EQUAL  FOR  DESIGN") 

5060=  LABORTs-1 

5070=  RETURN 

5080=  10  CALL  DSCRTD(LD,ZM1,ZM2) 

5090=  RETURN 

5100=C  END  SUBROUTINE  SDSN 

5110=  END 

5120=  SUBROUTINE  DSCRTD(LD,ZM1,ZM2) 

5130=  C0MM0N/MAIN1/NDIM,NDIM1,C0M1(1) 

5 1 40=  COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL , LABORT 

5150=  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

5160=  C0MMQN/SYSMTX/NVSM,SM(1) 

5170=  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

5180=  COMMON/LOCD/LAP , LGP , LPHI , LBD , LEX , LPHD , LQ , LQN , LQD , LC , LDY , LEY , LHP , LR 

5190=  COMMON/DSNMTX/NVDM,  NODY, NOEY, DM( 1 ) 

5200=  COMMON/LKF/LEADSN , LFLTRK , LFCOV 

5210=  C0MM0N/CKF/NVFLT,FLT(1) 

5220=  DIMENSION  LD(1),ZM1(1),ZM2(1) 

5230=  NDIMsNPLD 

5240=  NDIM1=NDIM+1 


5250= 

5260= 

5270=  1 

5280= 

5290= 

5300= 

5310= 

5320= 

5330=  5 

5340= 

5350= 

5360= 

5370= 

5380= 

5390= 

5400= 

5410= 

5420= 

5430=  8 

5440= 

5450= 

5460= 

5470*  10 

5480= 

5490= 

5500= 

5510= 

5520= 

5530= 

5540* 

5550= 

5560= 

5570= 


CALL  POLES (SM,NND,1,ZM1,ZM2) 

DO  1  1=1, NND 

IF(ZM1 (I) .GT.O.)  LFLCGTs-1 
CALL  TFRMTX(SM,DM,NND,NND,2) 

LAP=1 

LGP=LAP+NPLD«NPLD 
IF(NWD.EQ.O)  GO  TO  5 

CALL  TFRMTX (SM( LD ( 4 ) ) , DM( LGP ) , NND, NWD , 2 ) 
IF(NDD.EQ.O)  GO  TO  10 
LIsLADDR (NPLD, NND+1 , 1 ) 

L2= LADDR (NPLD , 1 , NND+1 } 

L3=LADDR (NPLD, NND+1 , NND+1 ) 

CALL  ZPART(DM(L1),NDD, NND, NPLD) 

CALL  TFRMTX (SM( LD ( 3 ) ) , DM( L2 ) , NND , NDD , 2 ) 

CALL  TFRMTX (SM(LD( 1 2 ) ) , DM(L3 ) , NDD, NDD, 2) 

IF(NWD.EQ.O)  GO  TO  8 

L1sL1+LGP-1 

CALL  ZPART(DM(L1 ), NDD, NWD, NPLD) 

L2= LADDR (NPLD, 1 ,NWD+1 )+LGP-1 
L3= LADDR ( NPLD , NND+ 1 , NWD+ 1 ) +LGP- 1 
CALL  ZPART(DM(L2), NND, NWDD, NPLD) 

CALL  TFRMTX(SM(LD(13))'DM(L3),NDD,NWDD,2) 

LPHI=LGP+NPLD*NWPNWD 

LEADSNal 

CALL  NDSCRT(DM, NDIM, NT) 

CALL  DSCRT ( NPLD , DM , TSAMP , FLT , ZM1 , NT ) 

LFLTRK=LEADSN+NPLD*NPLD 

CALL  TFRMTX (DM( LPHI), FLT, NND, NND, 1) 

LBD*LPHI+NND*NND 

CALL  TFRMTX (SM,ZM1, NND, NND, 1) 

CALL  FMMUL(SM, SM( LD ( 2 ) ) , NND , NND, NRD, DM( LBD ) ) 

LEX«LBD+NND*NRD 

IF(NDD.EQ.O)  GO  TO  15 
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5580* 

L1sLADDR(NPLD, 1,NND+1 ) 

5590s 

CALL  TFRMTX (DM( LEX ) , FLT (L 1 ) , NND , NDD , 1 ) 

5600s 

LPHDsLEX+NND*NDD 

5610s 

L1sLADDR(NPLD,NND+1 ,NND+1 ) 

5620s 

CALL  TFRMTX (DM(LPHD ) , FLT ( L 1 ) , NDD , NDD , 1 ) 

5630s 

LQ*LPHD+NDD*NDD 

5640s 

GO  TO  20 

5650s  15 

LQsLEX 

5660s  20 

IF(NVD.EQ.O)  GO  TO  25 

5670s 

CALL  FTMTX(SM(LD(5)),DM(LQ),NWD,NWD) 

5680s 

LQNsLQ+NVD*NWD 

5690* 

GO  TO  28 

5700*  25 

LQNsLQ 

5710*  28 

IF(NVDD.EQ.O)  GO  TO  33 

5720* 

CALL  FTMTX(SM(LD(  14) ),DM(LQN) ,NWDD,NWDD) 

5730s 

LQDsLQN+NWDD* NVDD 

5740s 

GO  TO  35 

5750s  33 

LQDsLQN 

5760s 

IF(NVPNUD.GT.O)  GO  TO  35 

5770s 

LCsLQD 

5780s 

GO  TO  36 

5790*  35 

CALL  QDSCRT(DM(LQ),DM(LQN),ZM1,ZM2) 

5800* 

LCsLQD+NPLD'NPLD 

5810*  36 

LDYsLC+NPD*NND 

5820* 

LEY*LDY+NPD»NRD 

5830* 

LHPsLEY+NPD*NDD 

5840* 

LRsLHP+NMD*NPLD 

5850* 

L1*LR+NMD»NMD-LC 

5860* 

CALL  FTMTX(SM(LD(6)),DM(LC),LT,1) 

5870s 

LlsLEY-1 

5880* 

NODYsl 

5890* 

DO  40  I*LDY,L1 

5900* 

IF(DM(I).EQ.O.)  GO  TO  40 

5910* 

NODYsO 

5920* 

GO  TO  45 

5930*  40 

CONTINUE 

5940*  45 

NOEYsl 

5950* 

IF(NDD.LT.I)  GO  TO  55 

5960* 

L1sLHP-1 

5970s 

DO  50  IsLEY,L1 

5980* 

IF(DM(I) .EQ.O.)  GO  TO  50 

5990* 

NOEYsO 

6000* 

GO  TO  55 

6010*  50 

CONTINUE 

6020*  55 

CALL  MATLST(DM(LPHI), NND, NND, "PHI” , KLIST) 

6030* 

CALL  MATLST ( DM( LBD ) , NND , NRD , "BD" , KLIST ) 

6040* 

IF(NWPNWD.GT.O)  CALL  MATLST (DM(LQD) , NPLD, NPLD, "QD" , KLIST) 

6050* 

IF(NMD.GT.O)  CALL  MATLST (DM( LHP) , NMD, NPLD, ’’HA" , KLIST) 

6060* 

IF(NDD.EQ.O)  RETURN 

6070* 

CALL  MATLST (DM( LEX ) , NND, NDD, "EXD" , KLIST) 

6080* 

CALL  MATLST ( DM( LPHD ) , NDD , NDD , "PHN* , KLIST ) 

6090* 

RETURN 

6100*C  END 

SUBROUTINE  DSCRTD 

6110* 

END 
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6120a  SUBROUTINE  QDSCRT ( Q , QN , ZM 1 , ZM2 ) 

6130a  C0MM0N/MAIN1 /NDIM, NDIM1 ,  C0M1 ( 1 ) 

6140a  COMMON/DESIGN/NVCOM, TSAMP, LFLRPI, LFLCGT, LFLKF, LTEVAL, L ABORT 

6150a  COMMON/NDIMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

6 1 60a  COMMON/LOCD/LAP , LGP , LPHI , LBD , LEX , LPHO , LQ  ,  LQN , LQD , LC , LDY , LEY , LHP , LR 

6170a  COMMON/DSNMTX/NVDM, NOD Y, NOEY , DM( 1 ) 

6180a  DIMENSION  Q(1 ),QN< 1 ),ZM1 (1 ),ZM2(1 ) 

6190a  IF(NWD.EQ.O)  GO  TO  5 

6200a  CALL  TFRMTX(Q,ZM1,NWD,NWD,2) 

6210a  5  IF(NWDD.EQ.O)  GO  TO  10 
6220a  L1aLADDR(NPLD,NWD+1,NWD+1) 

6230a  CALL  TPRMTX(QN,ZM1 (LI ), NWDD, NWDD, 2) 

6240a  IF(NWD.EQ.O)  GO  TO  10 

6250a  L1aLADDR(NPLD,1,NWD+1) 

6260a  CALL  ZPART(ZM1 (LI), NWD, NWDD, NPLD) 

6270a  L1aLADDR(NPLD, NWD+1 , 1 ) 

6280a  CALL  ZPART(ZM1 (LI ), NWDD, NWD, NPLD) 

6290a  10  CALL  MAT3(NPLD,NWPNVD,DM(LGP),ZM1,ZM2) 

6300a  CALL  INTEG( NPLD , DM ( LAP ) , ZM2 , DM( LQD ) , TSAMP ) 

6310a  RETURN 

6320aC  END  SUBROUTINE  QDSCRT 

6330a  END 

6340a  SUBROUTINE  SCMD( ND, LD, ICGT , ITYPE) 

6350a  C(MMON/DESIGN/NVCOM , TSAMP, LFLRPI, LFLCGT, LFLKF, LTEVAL, LABORT 

6360a  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

6370a  COMMON/SYSMTX/NVSM, SM( 1 ) 

6380a  C0MM0N/ZMTX1/NVZM,ZM1(1) 

6390a  C0MM0N/ZMTX2/ZM2 ( 1 ) 

6400a  COMMON/NDIMD/NND , NRD , NPD, NMD , NDD, NHD, NWDD, NPLD, NWPNWD, NNPR 

6410a  C0M40N/NDIMC/NNC, NRC , NPC 

6420a  COMMON/CMDMTX/NVCM, NEHCM, NODC, CM( 1 ) 

6430a  COMMON/LREGPI/LXDH, LUDW, LPHCL, LGC 1 , LGC2, LEL, LEE 

6440a  COMMON/CREGPI/NVRPI , RPI ( 1 ) 

6450a  DIMENSION  ND(1),LD(1) 

6460a  DATA  N0/1HN/ 

6470a  IF(ITYPE.EQ.4)  GO  TO  10 

6480a  WRITE(KLIST, 110} 

6490a  110  F0RMAT(////11X,5(W*  "),"CGT  DESIGN",5("  •")////) 

6500a  IF(LFLRPI)  10,5,10 

6510a  5  WRITE  102 
6520a  READ  111, IANS 

6530*  IF(IANS.EQ.NO)  GO  TO  8 

6540a  CALL  READFS(SM,ND,4,IERR) 

6550a  NSIZEaND(l) 

6560a  LGC1aND(2) 

6570a  LGC2aND(3) 

6580a  LE7.aND(4) 

6590a  CALL  FTMTX(SM, RPI (LGC 1),NSIZE,1) 

6600a  IF(IBRR.RE.O)  RETURN 

6610a  CALL  MATL3T(RPI(LGC1 ), NRD, NND,”GC1”, KLIST) 

6620a  CALL  MATLST (RPI ( LGC2 } , NRD , NRD , "GC2N , KLIST ) 

6630a  LFLRPIa-1 

6640a  GO  TO  10 

6650a  8  IF ( LFLCGT. GE.O)  GO  TO  9 
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6660« 

6670*  103 
6680* 

6690*  9 
6700* 

6710* 

6720* 

6730* 

6740*  10 
6750* 

6760*  108 
6770* 

6780* 

6790*  12 
6800* 

6810* 

6820* 

6830* 

6840* 

6850* 

6860* 

6870*  15 
6880*  102 
6890*  104 
6900*  111 
6910* 

6920*C  END 
6930* 

6940* 

6950* 

6960* 

6970* 

6980* 

6990* 

7000* 

7010* 

7020* 

7030* 

7040* 

7050* 

7060* 

7070* 

7080* 

7090* 

7100* 

7110* 

7120* 

7130* 

7140* 

7150* 

7160* 

7170* 

7180* 

7190* 

7200*  10 


WRITE  103 

FORMAT ( "OS YSTEM  UNSTABLE  -  -  OPEN-LOOP  CGT  NOT  FEASIBLE") 

RETURN 

LGCIsl 

LGC2.1 

LEL.1 

NSIZE*NRD*NND 

CALL  ZPART(RPI(LGC1 ) , 1 ,NSIZE, 1 ) 

IF(ICGT.EQ.O)  GO  TO  12 
WRITE  108 

FORMAT (■  MODIFY  COMMAND  MODEL  (Y  OR  N)  >") 

READ  111, IANS 

IF( IANS.EQ.NO)  return 

CALL  RSYS(SM,LD,ND,2,ICGT) 

IF(LABORT.NE.O)  RETURN 
NEWCMsI 

CALL  POLES(SM,NNC,2,ZM1,ZM2) 

IF(NPC.EQ.NPD)  GO  TO  15 

WRITE  104 

LABORTs-1 

RETURN 

CALL  DSCRTC(LD,ZM1) 

FORMAT ("  READ  REG/PI  GAINS  FROM  'DATA*  FILE  (Y  OR  N)  >") 

FORMAT ("OCOMttND  AND  DESIGN  MODEL  OUTPUTS  NOT  EQUAL  IN  NUMBER") 

FORMATU3)  *  - 

RETURN 

SUBROUTINE  SCMD 
END 

SUBROUTINE  DSCRTC(LD,ZM1 ) 

C0MM0N/MAIN1  /NDIM,  NDIM1,C0M1  ( 1 ) 

COMMON/D ESIGN/NVCOM, TSAMP , LFLRPI, LFLCGT , LFLKF . LTEVAL , LABORT 
COMMON/FILES/KSAVE , KDATA , KPLOT, KLIST , KTERM 
COMMON/SYSMTX/NVSM, SM( 1 ) 

COMMON/NDIMC/NNC , NRC , NPC 
COMION/LOCC/LPHC , LBDC , LCC , LDC 
COMMON/CMDMTX/NVCM, NEWCM, NODC , CM( 1 ) 

DIMENSION  LD( 1 ),ZM1  (1 ) 

NDIM. NRC 

NDIM1«NDDU1 

CALL  NDSCRT(SM,NDIM,NT) 

CALL  DSCRT(MDIM,SM, TSAMP, CM, ZM1 ,  NT) 

LPHC.1 

LBDCsLPHC+NNC’NNC 

CALL  IMUL(ZM1,SM(LD(2)), NDIM, NDIM, NRC,CM(LBDC) ) 

LCC*LBDC+NNC*NRC 
LDC*LCC+NPC»NNC 
LI  *LDC4>HPC*NRC-LCC 
CALL  FTMTX(SM(LD(3)),CM(LCC),L1,1) 

NODCsl 

L1.L1+LCC-1 

DO  10  I*LDC,L1 

IF(CM(I).EQ.O.)  GO  TO  10 

NODCsO 

GO  TO  15 

CONTINUE 
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7210s  15  CALL  MATLST (CM, NNC , NNC , "PHM" , KLIST) 

7220s  CALL  MATLST ( CM( LBDC ) , NNC , NRC , "BOM” , KLIST ) 

7230s  CALL  MATLST(CM*LCC),NPC,NNC, "CM", KLIST) 

7240s  CALL  MATLST ( CM( LDC ) , NPC ,  NRC , "DM" , KLIST ) 

7250s  RETURN 

7260sC  END  SUBROUTINE  DSCRTC 

7270s  END 

7280s  SUBROUTINE  STRTH*ND,LD,ITRU) 

7290s  COtftfON/DESIGN/NVCOM , TSAMP , LFLRPI , LFLCGT, LFLKF, LTEVAL, L ABORT 

7300s  COMMON/SYSMTX/NVSM, SM( 1 ) 

7310s  C0MM0N/ZMTX1/NVZM,ZM1 *1) 

7320s  C0MM0N/ZMTX2/ZM2 ( 1 ) 

7330s  COMMON/NDIMD/NND, NRD, NPD,NMD, NDD, NWD , NWDD, NPLD,  NWPNWD, NNPR 

7340s  COMMON/ND IMT/NNT , NRT, NMT, NWT 

7350s  DIMENSION  ND(1),LD(1) 

7360s  DATA  N0/1HN/ 

7370s  IF(ITRU.EQ.O)  GO  TO  5 

7380s  WRITE  103 

7390s  103  FORMAT*"  MODIFY  TRUTH  MODEL  (Y  OR  N)  >») 

7400s  READ  111, IANS 

7410s  111  F0RMAT(A3) 

7420s  IF(IANS.EQ.NO)  GO  TO  20 

7430s  5  CALL  RSYS(SM, LD , ND , 3  > ITRU) 

7440s  IF(LABORT.GT.O)  RETURN 

7450s  NSIZEsNNT*NNT 

7460s  IF(NSIZE.LE.NVCOM)  GO  TO  8 

7470s  WRITE  101,NSIZE 

7480s  101  FORMAT* "OINSUFFICIENT  MEMORY  /MAIN1/, /MAIN2/,/ZMTX1/, /ZMTX2/,  NEED 
7490s  Is  ",I2) 

7500s  LABORTsNSIZE 

7510s  RETURN 

7520s  8  IF* (NRT. EQ. NRD) .AND. (NMT. EQ. NMD) )  GO  TO  10 

7530s  WRITE  102 

7540s  102  FORMAT* "OINPUTS  AND  MEASUREMENTS  MUST  BE  EQUAL  IN  NUMBER  FOR  DESIG 
7550s  IN  AND  TRUTH  MODELS") 

7560s  LABORTs-1 

7570s  RETURN 

7580s  10  CALL  P0LES*SM,NNT,3»ZM1,ZM2) 

7590s  CALL  DSCRTT(LD,ZM1) 

7600s  20  LTEVALsI 
7610s  RETURN 

7620sC  END  SUBROUTINE  STRTH 
7630s  END 

7640s  SUBROUTINE  DSCRTT*LD,ZM1 ) 

7650s  C0MM0N/MAIN1/NDIM,NDIM1,C0M1(1) 

7660s  COMMON/D ESIGN/NVCOM, TSAMP, LFLRPI, LFLCGT, LFLKF, LTEVAL, LABOR T 

7670s  C0M40N/SYSMTX/NVSM, SM( 1 ) 

7680s  C0M40N/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

7690s  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

7700s  COMMON/NDIMT/NNT , NRT , NMT , NWT 

7710s  COMMON/LOCT/LPHT, LBDT, LQDT, LHT, LRT, LTDT, LTNT 

7720s  COMMON/TRUMTX/NVTM, TM* 1 ) 

7730s  DIMENSION  LD*1),ZM1*1) 

7740s  NDIMsNNT 

7750s  NDIM1sNDIM+1 
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7760* 

7770* 

7780* 

7790* 

7800* 

7810* 

7820* 

7830* 

7840* 

7850*  10 
7860* 

7870* 

7880*  15 
7890* 

7900* 

7910* 

7920* 

7930* 

7940* 

7950* 

7960* 

7970*C  END 
7980* 

7990* 

8000* 

8010* 

8020* 

8030* 

8040* 

8050* 

8060* 

8070* 

8080* 

8090* 

8100* 

8110* 

8120*  110 
8130* 

8140* 

8150* 

8160* 

8170*  101 
8180* 

8190* 

8200*  10 
8210* 

8220* 

8230* 

8240* 

8250* 

8260* 

8270* 

8280* 

8290* 

8300* 


CALL  NDSCRT(SM,NDIM,NT) 

CALL  DSCRT ( NDIM, SM, TSAMP , TM, ZM1 , NT) 

LPHTsI 

LBDT*LPHT+NNT*NNT 

CALL  W!UL (ZM1,SM(LD(2)),NDIM, NDIM, NRT, TM(LBDT) ) 

LQDT*LBDT+NNT*NRT 
IF(NWT.GT.O)  GO  TO  10 
LHTsLQDT 
GO  TO  15 

CALL  MAT3(NDIM,NVT,SM(LD(3))»SM(LD(4)),ZM1) 

CALL  INTEG( NDIM, SM, ZM1 , TM( LQDT) , TSAMP ) 

LHTsLQDT+NNT*NNT 

LRT*LHT+HMT»NNT 

LTDT*LRT-4.NMT»NMT 

LTNT*LTDT+NND»NNT 

L1*LTNT+NDD*NNT-LHT 

CALL  FTMTX(SM(LD(5)),TM(LHT),L1,1) 

CALL  MATLST(TM, NNT, NNT, "PHT" ,KLIST) 

CALL  MATLST (TM( LBDT ) , NNT, NRT, "BDT" ,KLIST) 

IP(NVT.GT.O)  CALL  MATLST (TM( LQDT), NNT, NNT, *QDT",KLIST) 

RETURN 

SUBROUTINE  DSCRTT 
END 

SUBROUTINE  PIMTX(IPI) 

COMMON/MAIN 1 /NDIM, NDIM1 , C0M1 ( 1 ) 

COMMON/D E3IGN/NVC0M, TSAMP , LFLRPI , LFLCGT, LFLKF, LTEVAL, LABORT 
COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 
COMMON/ZMTX1 /NVZM, ZM1 ( 1 ) 

C0MM0N/ZMTX2/ZM2 ( 1 ) 

COMfON/NDIMD/NND , NRD, NPD, NMD, NDD, HWD, NWDD, NPLD, NWPNWD , NNPR 
COMMON/LOCD /LAP , LGP , LPHI , LBD , LEX , LPHD , LQ, LQN, LQD, LC, LDY, LEY, LHP, LR 
COMKON/DSNMTX/NVDM, NODI, NOEI,DM( 1 ) 

COMHON/LCNTRL/LPI 1 1 ,LPI12,LPI21 , LPI22 , LPHDL , LBDL 
COMttN/CONTROL/NVCTL, CTL( 1 ) 

IP(IPI.EQ.I)  RETURN 
WRITE(KLIST, 110) 

F0RMAT(////11X,5("*  "), "CONTROLLER  SET-UP", 5("  •")////) 

NDIM* NNPR 

NSIZEsNDIM* (2*NDIM+NPD ) 

IF(NSIZE.LE.NTCTL)  GO  TO  10 
WRITE  101 ,NSIZE 

FORMAT ("OINSUFFICIENT  MEMORY  /CONTROL/,  NEED:  ",I4) 

LABORT* NSIZE 
RETURN 
NDIM1.NDIM+1 
LPI 11*1 

LP1 1 2*LP1 1 1  -*>NND*NND 
LPI2 1 *LPI 1 2+NND*NRD 
LPI22  *  LPI2 1 +NPD*NND 
LPHDL*LPI22+NPD*NRD 
CALL  TFRMTX(DM(LPHI),ZM1,NND,NND,2) 

CALL  SUBI(ZM1,NND,NDIM) 

L2*LADDR ( NDIM, 1 , NND+1 ) 

CALL  TFRMTX(DM(LBD) ,ZM1 (L2),NND,NRD,2) 

L3*LADDR(NDIM, NND+1 , 1 ) 
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8310*  CALL  TFRMTX(DM(LC),ZM1(L3),NPD,NND,2) 

8320s  L4sLADDR(NDIM,NND+1,NND+1) 

8330s  CALL  TFRMTX (DH(LDY) , ZM1 (LU ) , NPD, NRD, 2 ) 

8340s  CALL  GMINV(NDIM,NDIM,ZM1,ZM2,MR, 1) 

8350s  IF(MR.EQ.NDIM)  GO  TO  15 

8360s  WRITE  102 

8370s  WRITE (KLIST, 102) 

8380s  102  FORMAT ("OPI  MATRIX  IS  RANK  DEFECTIVE") 

8390s  15  CALL  MATLST ( ZM2 , HNPR , NNPR , "PI" , KLIST ) 

8400s  CALL  TFRMTX (CTL(LPI1 1 ) *  ZM2, NND, NMD* 1 ) 

8410s  CALL  TPRMTX(CTL(LPI12),ZM2(L2),NND,NRD, 1) 

8420s  CALL  TFRMTX (CTL(LPI21 ) , ZM2 (L3) , NPD, NND, 1 ) 

8430s  CALL  TFRMTX (CTL(LPI22),ZM2(L4), NPD, NRD, 1) 

8440s  CALL  CDIF 

8450s  IPIsI 

8460s  RETURN 

8470sC  END  SUBROUTINE  PIMTX 

8480s  END 

8490s  SUBROUTINE  CDIF 

8500s  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

8510s  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

8520s  COIMON/LOCD/LAP , LGP , LPHI , LBD, LEX, L PHD, LQ, LQN, LQD, LC,LDY, LEY, LHP , LR 

8530s  COMMON/DSNMTX/NVDM, NODY, NOEY,DM( 1 ) 

8540s  COMMON/LCNTRL/LPI 1 1 ,LPI12,LPI21 , LPI22 , LPHDL , LBDL 

8550s  COMMON/CONTROL/NVCTL, CTL( 1 ) 

8560s  CALL  TFRMTX (DM(LPHI),CTL(LPHDL), NND, NND, 2) 

8570s  L1sLADDR(NDIM,  1 ,NND+1  )+LPHDL-1 

8580s  CALL  ZPART(CTL(L1 ), NND, NPD, NDIM) 

8590s  L1sLADDR(NDIM,NND+1 , 1 )+LPHDL-1 

8600s  CALL  TFRMTX (DM(LC),CTL(L1), NPD, NND, 2) 

8610s  L1sLADDR(NDIM,NND+1 ,NND+1 )+LPHDL-1 

8620s  CALL  IDNT(NRD,CTL(L1),1.) 

8630s  LBDLsLPHDU-NDIM«NDIM 

8640s  CALL  TPRMTX (DM(LBD) , CTL(LBDL) , NND, NRD, 2 ) 

8650s  L1sLADDR(NDIM,NND+1,1)+LBDL-1 

8660s  CALL  TFRMTX(DM(LDY),CTL(L1),NPD,NRD,2) 

8670s  RETURN 

8680sC  END  SUBROUTINE  CDIF 
8690s  END 

8700s  SUBROUTINE  SREGPI(IMPLIC) 

8710s  CQMM0N/MAIN1 /NDIM, NDIM1 ,C0M1  ( 1 ) 

8720s  COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT, LFLKF, LTEVAL, LABORT 

8730s  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

8740s  COMMON/SYSMTX/NVSM, SM( 1 ) 

8750s  C0MM0N/ZMTX1 /NVZM,ZM1 ( 1 ) 

8760s  C0M10N/ZMTX2/ZM2 ( 1 ) 

8770s  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

8780s  COMMON/LCNTRL/LPI 1 1 ,LPI12,LPI21 ,LP 122, LPHDL, LBDL 

8790s  COMMON/CONTROL/NVCTL, CTL( 1 ) 

8800s  COMfON/LREGPI/LXDW, LUDW , LPHCL, LGC 1 , LGC2 , LEL, LEE 

8810s  COMMON/CREGPI/NVRPI , RPI ( 1 ) 

8820s  COMMON/LOCD/LAP , LGP , LPHI , LBD , LEX , LPHD , LQ , LQN , LQD , LC , LDY ,  LEY , LHP , LR 

8830s  COMMON/DSNMTX/NVDM, NODY, NOEY,DM( 1 ) 

8840s  WRITE(KLIST, 110) 

8850s  110  F0RMAT(////11X,5C,t  "),"REG/PI  DESIGN", 5("  •")////) 


8860s  NSIZEsMRD* ( 5 •NRD+2 *NND ) ♦NNPR*NNPR 

8870s  IF ( NSIZE •  LE . NVRPI )  GO  TO  5 

8880s  WRITE  101, NSIZE 

8890s  101  FORMAT ("0 INSUFFICIENT  MEMORY  /CREGPI/,  NEED:  «,I4) 

8900s  GO  TO  8 

8910s  5  NSIZEsNN?R*(3*NNPR+NRD) 

8920s  IF(NSIZE.LE.NVSM)  GO  TO  10 

8930s  WRITE  102, NSIZE 

8940s  102  FORMAT ("OINSUFFICIENT  MEMORY  /SYSMTX/,  NEED:  ”,I4) 

8950s  8  LABORTsNSIZE 
8960s  RETURN 

8970s  10  LXsl 

8980s  LUsLX+NNPR*NNPR 

8990s  CALL  WXUS(SM(LX ) , SM(LU) , C0M1 ,ZM1 , ZM2, IMPLIC ) 

9000s  LUISTsLU+NNPR»NRD 

9010s  LPHPsLUIST+NNPR*NNPR 

9020s  CALL  PXUP(CTL(LPHDL),CTL(LBDL),SM(LX),SM(LU) ,C0M1 ,ZM2, 

9030s  1  SM(LUIST),SM(LPHP),SM(LX),ZM1 ) 

9040s  CALL  DRIC ( NDIM, SM( LPHP ) , ZM2 , SM( LX ) , ZM1 , RPI ( LPHCL) ) 

9050s  CALL  GCSTAR(SM(LPHP),CTL(LBDL),SM(LU),ZM1,SM(LUIST),SM(LX),ZM2) 

9060s  CALL  TFRMTX(RPI(LGC1 ),SM(LX),NRD,NND, 1 ) 

9070s  L3sLADDR(NDIM, 1,NND+1  )+LX-1 

9080s  CALL  TFRMTX(RPI(LGC2),SM(L3),NRD,NRD,1) 

9090s  L1sLADDR(NNPR,NND+1,NND+1) 

9100s  L2sLADDR(NNPR, 1 ,NND+1 ) 

9110s  CALL  GMINT(NRD,NRD,ZM1 (LI ),ZM1 (L2),MR, 1 ) 

9120s  L1sLADDR(NNPR,NND+1 , 1 ) 

9130s  CALL  MMUL(ZM1 (L2),ZM1 (LI ),NRD, NRD,NND,ZM1 ) 

9140s  CALL  MMUL(SM(L3),ZM1,NRD,NRD,NND,ZM1(L1)) 

9150s  CALL  MADD1(NHD,NND,SM(LX),ZM1(L1),ZM1,-1.) 

9160s  CALL  TFRMTX(RPI(LEL),ZM1,NRD,NND,1) 

9170s  CALL  FMMUL(RPI(LEL) ,CTL(LPI12),NRD,NND,NRD,RPI(LEE) ) 

9180s  CALL  FMADD(RPKLEE) ,CTL(LPI22),NRD,NRD,RPI(LEE) ) 

9190s  CALL  MATLST(RPI(LGC1),MRD,NND,"GC1',,KLIST) 

9200s  CALL  MATLST(RPI(LGC1),NRD,NND,*GC1”,KTERM) 

9210s  CALL  MATLST ( RPI ( LGC2 ) , NRD , NRD , *GC2* , KLIST ) 

9220s  CALL  MATLST ( RPI (LGC2 ) , NRD, NRD, ”GC2” , KTERM) 

9230s  CALL  MATLST (RPI (LEE), NRD, NRD, "E", KLIST) 

9240s  IF(N0DY.EQ.1)G0  TO  15 

9250s  CALL  FMMUL(RPI(LEE) ,DM(LDY) , NRD, NRD, NRD, ZM1 ) 

9260s  CALL  SUBI(ZM1 ,NRD,NRD) 

9270s  NR2sNRD*NRD 

9280s  DO  12  Is1,NR2 

9290*  12  ZM1 (I)s-ZMI (I) 

9300s  NDIMsNRD 

9310s  NDIMIsNDUWI 

9320s  CALL  GMINV(NRD,NRD,ZM1,ZM2,MR,1) 

9330s  CALL  FMMUL(ZM2,RPI(LEE),NRD,NRD,NRD,ZM1) 

9340s  CALL  MATLST ( ZM1 , NRD , NRD , ”KP” , KLIST ) 

9350s  CALL  FMMUL(ZM2,RPI(LGC2),NRD,NRD,NRD,ZM1) 

9360s  CALL  MATLST ( ZM1 , NRD , NRD , "K I" , KLIST ) 

9370s  GO  TO  20 

9380s  15  WRITE (KLIST, 103) 


9390s  103  FORMAT ("OKP  =  E  AND  KI  s  GC2") 

9400s  20  CONTINUE 

9410s  LFLRPIsI 

9420s  LFLCGTsO 

9430s  RETURN 

9440sC  END  SUBROUTINE  SREGPI 

9450s  END 

9460s  SUBROUTINE  WXUS(X,U,S,ZM1 ,ZM2,IMPLIC) 

9470s  C0MM0N/MAIN1/NDIM,  NDIM1 , C0M1 ( 1 ) 

9480s  C0MM0N/MAIN2/C0M2 ( 1 ) 

9490s  COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , LFLKF, LTEVAL ,  LABORT 

9500s  COMfON/FILES/KSAVE , KDATA , KPLOT , KLIST , KTERM 

9510s  COMMON/SYSMTX/NVSM, SM( 1 ) 

9520s  COMMON/NDIMD/NND , NRD, NPD, NMD, NDD, NWD , NWDD, NPLD, NWPNWD, NNPR 

9530s  COMMON/LOCD/LAP ,LGP,LPHI,LBD,LEX,LPHD,LQ,LQN, LQD , LC , LDY , LEY , LHP , LR 

9540s  COMKON/DSNMTX/NVDM,NODY,NOEY,DM( 1 ) 

9550s  C0MM0N/LCNTRL/LPI11 ,LPI12,LPI21 , LPI22 , LPHDL, LBDL 
9560s  COMMON/CONTROL/NVCTL, CTL( 1 ) 

9570s  COM(ON/LREGPI/LXDV, LUDN, LPHCL, LGC 1 , LGC2, LEL, LEE 

9580s  COMMON/CREGPI/NVRPI , RPI ( 1 ) 

9590s  DIMENSION  X(1)fU(1)yS(1)yZM1(1)fZM2(1) 

9600s  DATA  N0/1HN/ 

9610s  IF(IMPLIC.EQ.O)  GO  TO  2 

9620s  CALL  IMPLEX (ZM1) 

9630s  2  IF(LFLRPI)  5,5,10 

9640s  5  LXDWsI 

9650s  LUDWsLXDW+2*NRD*NRD 

9660s  LPHCLsLUDH-fNRD#NRD 

9670s  LGC1sLPHCL+NNPR»NNPR 

9680s  LGC2sLGC 1 ♦NRD*NND 

9690s  LELsLGC2+NRD*NRD 

9700s  LEEsLEU>NRD«NND 

9710s  L1sLPHCL-1 

9720s  CALL  ZPART(RPI,1,L1,1) 

9730s  10  LUXsNRD*NRD-t>1 
9740s  WRITE  101, NPD 

9750s  101  FORMAT ("  ENTER  WEIGHTS  ON  OUTPUT  DEVIATIONS:  ",I2) 

9760s  CALL  RQWGTS( RPI , NPD , 0 ) 

9770s  WRITE  102, NRD 

9780s  102  FORMAT (w  ENTER  WEIGHTS  ON  INTEGRAL  OF  REGULATION  ERROR:  ",I2) 

9790s  CALL  RQWGTS(RPI(LUX),NRD, 1 ) 

9800s  WRITE  103, NRD 

9810s  103  FORMAT ("  ENTER  WEIGHTS  ON  CONTROL  MAGNITUDES:  ”,I2) 

9820s  CALL  RQWGTS(RPI(LUDW) ,NRD, 1 ) 

9830s  CALL  MATLST (RPI, NPD, NPD, NYM, KLIST) 

9840s  CALL  DVCT0R(NPD,RPI,ZM1) 

9850s  CALL  MATLST(ZM1 , NPD, 1 , "Y" , KTERM) 

9860s  CALL  DVCT0R(NRD,RPI(LUX),ZM1) 

9870s  CALL  MATLST (ZM1, NRD, 1,”UQ”, KTERM) 

9880s  CALL  MATLST ( RPI ( LUX ) , NRD, NRD , ”UQ” , KLIST ) 

9890s  NDIMsNNPR 

9900s  NDIM1sNDIM+1 

9910s  CALL  FORMXU ( RPI , RPI ( LUX ) , RPI ( LUDW) , DM( LC ) , DM( LDY) , ZM2 , ZM1 , C0M1 ) 
9920s  WRITECKTERM, 104 ) 

9930s  104  FORMAT( "OMODIFY  ELEMENTS  OF  'X*  MATRIX  (Y  OR  N)  >") 


ran 


994C*  READ  111, IANS 

9950*  111  FORMAT (A3) 

9960*  IF(IANS.EQ.NO)  GO  TO  20 

9970*  VRITE(KTERM, 105) 

9980*  105  FORMAT ("  LIST  *X’  MATRIX  TO  TERMINAL  (Y  OR  N)  >") 

9990*  READ  111, IANS 

10000*  IF(IANS.EQ.NO)  GO  TO  12 

10010*  CALL  MATLST(ZM2, NNPR, NNPR, ”X" , KTERM) 

10020*  12  CALL  ZMATIN(ZM2,NNPR,MNPR,-1 ) 

10030*  20  CALL  MATLST(ZM2, NNPR, NNPR, ”X”,KLIST) 

10040*  CALL  MATLST(RPI(LUDH) , NRD, NRD, "UM" , KLIST) 

10050*  CALL  D?CT0R(NRD,RPI(LUDW),ZM1) 

10060*  CALL  MATLST(ZM1, NRD, 1,NUMtt, KTERM) 

10070*  IF(IMPLIC.EQ.O)  GO  TO  260 

10080*  CALL  M0DXU(ZM2,RPI(L0DW) ) 

10090*  260  CONTINUE 

10100*  T1s«25*TSAMP 

10110*  CALL  MSCALE(ZM1,ZM2,NDIM,NDIM,T1) 

10120*  CALL  DIAG(NDIM,C0M1,CTL(LPHDL),1.,1.) 

10130*  CALL  MAT3A(NDIM, NDIM, C0M1 , ZM1 , X) 

10140*  CALL  MAT3A ( NRD , NDIM, CTL ( LBDL ) , ZM1 , U ) 

10150*  CALL  MAT4A(C0M1, ZM1, NDIM, NDIM, NDIM, ZM2) 

10160*  CALL  MMUL(ZM2,CTL(LBDL), NDIM, NDIM, NRD,S) 

10170*  T1*.5*TSAMP 

10180*  CALL  MSCALE (COM2, COM2, NNPR, NRD, T1 ) 

10190*  CALL  MATA  A  (C0M1,  COM2,  NDIM,  NDIM,  NRD,ZM1 ) 

10200*  CALL  MADD1 (NDIM, NRD, ZM1,S,S,1.) 

10210*  CALL  FTMUL(CTL(LBDL) , COM2, NDIM, NRD, NRD,C0M1) 

10220*  NRD2sNRD*NRD 

10230*  DO  25  1*1, NRD 

10240*  K*(I-1)*NRD 

10250*  JK*K+LUDW 

10260*  DO  25  J*I,NRD2,NRD 

10270*  K*K+1 

10280*  C0M2(K)*C0M1 (K)+C0M1 ( J)+RPI( JK)«TSAMP 

10290»  25  JK*JK+1 

10300*  CALL  TFRMTX (COM2 » ZM1 , NRD , NRD , 2 ) 

10310*  CALL  MADD1 (NRD,NRD,U,ZM1,U, 1«) 

10320*  RETURN 

10330*C  END  SUBROUTINE  WXUS 
10340*  END 

10350*  SUBROUTINE  F0RMXU(QY,RY,RU,C,D,X,Z1,Z2) 

10360*  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD , NPLD , NHPNWD , NNPR 

10370*  C0MM0N/MAIN2/C0M2O) 

10380*  DIMENSION  QY(1),RY(1),C(1),D(1),X(1),Z1(1),Z2(1) 

10390*  CALL  ZPART(X,NNPR, NNPR, NNPR) 

10400*  CALL  FTMUL(C,QY,NPD,NND,NPD,Z1) 

10410*  CALL  FM1UL(Z1,C,NND,NPD,NND,Z2) 

10420*  CALL  TFRMTX(Z2,X,NND,NND,2) 

10430*  L1*LADDR(NNPR,NMD+1,NND+1) 

10440*  CALL  TFRMTX (RY,X (LI)  NRD, NRD, 2) 

10450*  L2*LADDR(M  R.NND  ,  i) 

10460*  CALL  ZPART(uv^>’ (L^,, NRD, NRD, NNPR) 

10470*  IF(NODY.EQ.O)  GO  TO  5 

10480*  CALL  ZPART(C0M2,NND, NRD, NNPR) 


10490s  RETURN 

10500s  5  CALL  FMMUL(Z1,D,NND,NPD,NRD,Z2) 

10510s  CALL  TFRMTX(Z2,C0M2,NND,NRD,2) 

10520s  CALL  FMMUL(QY,D,NPD,NPD,NRD,Z1) 

10530s  CALL  FTMUL(D,Z1,NPD,NRD,NRD,Z2) 

10540s  CALL  FMADD(Z2,RU,NRD,NRD,RU) 

10550s  RETURN 

10560sC  END  SUBROUTINE  FORMXU 

10570s  END 

10580s  SUBROUTINE  PXUP(PHIDL,BDEL,X, U,S,BUIBT,UIST,PHIP,XP,ZM1 ) 

1 0590s  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

1 0600s  COMMON/NDIMD/NND , NRD , NPD , NMD , NDD , NWD , NVDD , NPLD , NWPNWD , NNPR 

10610s  DIMENSION  PHIDL ( 1 ) , BDEL( 1),X(1),U(1),S(1), BUIBT ( 1 ) , UIST ( 1 ) , 
10620s  1  PHIP(1),XP(1),ZM1(1) 

10630s  CALL  EQUATE (PHIP,U, NRD, NRD) 

10640s  CALL  GMINV(NRD,NRD,PHIP,ZM1,MR,1) 

10650s  CALL  MAT3(NDIM, NRD, BDEL,ZM1, BUIBT) 

10660s  CALL  MAT5(ZM1,S, NRD, NRD, NDIM, UIST) 

10670s  CALL  »1UL(BDEL, UIST, NDIM, NRD, NDIM, ZM1) 

10680s  CALL  MADD1 (NDIM, NDIM, PHIDL,ZM1,PHIP,~’  ) 

10690s  CALL  MfUL(S, UIST, NDIM, NRD, NDIM, ZM1) 

10700s  CALL  MADD1 (NDIM, NDIM, X,ZM1,XP,-1.) 

10710s  RETURN 

10720sC  END  SUBROUTINE  PXUP 
10730s  END 

10740s  SUBROUTINE  GCSTAR(PHIP,BDEL,U,RK,UIST,GCS,ZM1 ) 

10750s  C0MM0N/MAIN1/NDIM, NDIM1 ,C0M1 ( 1 ) 

1 0760s  COMMON/FILES/KSAVE , KDATA , KPLOT, KLIST , KTERM 

10770s  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NVD, NWDD, NPLD, NWPNWD, NNPR 

10780=  DIMENSION  PHIP(1),BDEL(1 ),U(1 ),RK( 1 ),UIST(1 ),GCS(1 ),ZM1 (1 ) 

10790=  CALL  MAT3A(NRD,NDIM,BDEL,RK,ZM1) 

10800s  CALL  MADD1 (NRD,NRD,ZM1 ,U,ZM1 , 1 .) 

10810s  CALL  GMINV(NRD,NRD,ZM1,U,MR, 1 ) 

10820=  CALL  MAT5(U,BDEL, NRD, NRD, NDIM, ZM1) 

10830s  CALL  MAT1(ZM1,RK, NRD, NDIM, NDIM, GCS) 

10840s  CALL  MUL(GCS, PHIP, NRD, NDIM, NDIM, ZM1 ) 

10850s  CALL  MADD1 (NRD, NDIM, ZM1, UIST, GCS, 1.) 

10860=  WRITE(KLIST, 101 ) 

10870s  101  FORMATCOREG/PI  GAIN  MATRIX--GCS"/) 

10880s  CALL  MATIO(GCS,NRD, NDIM, 3 ) 

10890=  RETURN 

10900sC  END  SUBROUTINE  GCSTAR 

10910=  END 

10920=  SUBROUTINE  SCGT 

1 0930=  COMMON/DESIGN/NVCOM, TSAMP, LFLRPI , LFLCGT, LFLKF, LTEVAL, LABORT 

10940=  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

10950=  C0MM0N/ZMTX1 /NVZM, ZM1 ( 1 ) 

10960=  C0MM0N/ZMTX2/ZM2 ( 1 ) 

10970=  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NVD, NWDD, NPLD, NWPNWD, NNPR 

10980=  COMMON/ND IMC/NNC , NRC , NPC 

10990s  COMMON/CMDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

1 1000=  COMMON/LREGPI/LXDW, LUDW, LPHCL, LGC 1 , LGC2, LEL, LEE 

11010=  COMMON/CREGPI/NVRPI,RPI( 1 ) 

1 1020=  COMMON/LCGT/LA 1 1 , LA 1 3 , LA2 1 , LA23 , LA 1 2 , LA22 , LELA 1 1 , LELA 1 2 , LELA 1 3 

11030=  COMMON/CCGT/NVCGT,CGT( 1 ) 


>> 


11040s  IF(NEWCM)  20,20,15 

11050s  15  NSIZEs ( NND+2 *NPD ) * ( NNC+NRC+NDD ) 

11060s  IF ( NSIZE . LE . NVCGT )  GO  TO  16 

11070s  WRITE  106, NSIZE 

11080s  LABORTsNSIZE 

1 1090s  RETURN 

11100s  16  IF(NND.GE.NNC)  GO  TO  17 

11110s  WRITE  107 

11120s  GO  TO  18 

11130s  17  IF(NND.GE.NDD)  GO  TO  19 

11140s  WRITE  108 

11150s  18  LABORTs-1 

11160s  RETURN 

11170s  19  NEWCMsO 

11180s  LAIIsl 

11190s  LA13sLA11+NND*NNC 

11200s  LA2 1 sLA 1 3+NND#NDD 

11210s  LA23=LA21+NPD»NNC 

11220s  LA12sLA23+NPD»NDD 

11230s  LA22=LA12+NND*NRC 

11240s  LELA11sLA22+NPD»NRC 

11250s  LELA 1 2=LELA 1 1 +NPD*NNC 

11260s  LELA 1 3 = LELA 1 2+NPD*NRC 

1 1270s  CALL  CGTA(CGT(LA11 ) ,CGT(LA13) ,CGT(LA21 ) ,CGT(LA23) ,CGT(LA12), 

11280s  1  CGT(LA22) ,ZM1 ,ZM2) 

11290s  20  CALL  CGTKX(CGT(LA11),CGT(LA13),CGT(LA21),CGT(LA23),CGT(LA12), 

11300s  1  CGT(LA22),CGT(LELA11),CGT(LELA12),CGT(LELA13),RPI(LEL)) 

11310s  LFLCGTsI 

11320s  106  FORMAT ("0 INSUFFICIENT  MEMORY  /CCGT/,  NEED:  **,I4) 

11330s  107  FORMAT ("OFEWER  DESIGN  MODEL  THAN  COMMAND  MODEL  STATES") 

11340s  108  FORMAT ("FEWER  DESIGN  MODEL  THAN  DISTURBANCE  MODEL  STATES") 

11350s  RETURN 

11360sC  END  SUBROUTINE  SCGT 
11370s  END 

11380s  SUBROUTINE  CGTA(A11,A13,A21,A23,A12,A22,ZM1,ZM2) 

1 1390s  C0MM0N/MAIN1/NDIM,NDIM1 ,C0M1 (1 ) 

1 1400s  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

11410s  COMMON/SYSMTX/NVSM, SM( 1 ) 

1 1420s  COMMON/ND IMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD , NPLD , NWPNWD , NNPR 

11430s  COMMON/LOCD/LAP, LGP , LPHI , LBD , LEX , LPHD , LQ , LQN , LQD , LC , LDY , LEY, LHP , LR 

1 1440s  COMMON/DSNMTX/NVDM, NOD Y , NOE Y , DM( 1 ) 

11450s  COMMON/NDIMC/NNC , NRC , NPC 

1 1460s  COMMON/LOCC/LPHC , LBDC , LCC , LDC 

11470s  COMMON/CMDMTX/NVCM, NEWCM, NODC , CM( 1 ) 

1 1480s  COMMON/LC  NTRL/LP1 1 1 , LP1 12 , LPI21 , LPI22 , LPHDL, LBDL 

11490s  COMMON/CONTROL/NVCTL,CTL( 1 ) 

11500s  DIMENSION  All (1 ),A13(1 ),A21 (1 ),A23(1),A12(1 ),A22(1 ),ZM1 ( 1 ),ZM2( 1 ) 

11510s  NDIMsNND 

11520s  NDIM1sNDIM+1 

11530s  CALL  TFRMTX(CM,ZM1,NNC,NNC,2) 

11540s  CALL  SUBI(ZM1 ,NNC,NDIM) 

11550s  CALL  FMMUL(CTL(LPI12) ,CM(LCC) ,NND,NRD,NNC,ZM2) 

11560s  CALL  MSCALE ( ZM2 , ZM2 , NND , NNC , - 1 • ) 

11570s  NBsMAXO ( NDD , NNC ) 

11580s  L2s1+NND*NND 


1 1590a  L3=L2+NND*NB 

11600s  U=L3+NND»NB 

11610s  L5sL4+NND*NND 

11620s  L6aL54>NND*NND 

1 1 630s  NSIZEsL6+NPD*NNC-1 

11640s  IF(NSIZE.LE.NVSM)  GO  TO  1 

11650s  WRITE  102,NSIZE 

11660s  102  FORMAT ("OINSUFFICIENT  MEMORY  /SYSMTX/,  WEED:  ",I4) 
11670s  LABORTsNSIZE 

11680s  RETURN 

11690s  1  CALL  AXBMXC(CTL(LPI11)*NNDyZM1yNNCfZM2yA11ySM* 

11700s  1  SM(L2),SM(L3),SM(L4),SM(L5)) 

11710s  CALL  MMUL(A11,ZM1,NND,NNC,NNC,ZM2) 

11720s  CALL  FMMUL(CTL(LPI21 )*ZM2*NPDlNNDyNNCyA21 ) 

11730s  CALL  FMMUL( CTL( LPI22 ) , CM( LCC ) , NPD , NRD , NNC , SM( L6 ) ) 

11740s  CALL  FMMUL(A11,CM(LBDC),NND,NNC,NRC,SM) 

11750s  CALL  FMMUL(CTL(LPI11)*SM,NNDyNND,NRCyA12) 

11760s  CALL  FMMUL(CTL(LPI21)ySMyNPD,NNDyNRCyA22) 

11770s  IF(NODC.EQ.I)  GO  TO  2 

11780s  CALL  FMMUL(CTL(LPI12)yCM(LDC)yNNDyNRDyNRCySM(L2)) 

11790s  CALL  FMADD(A12ySM(L2)yNND,NRCyA12) 

11800s  CALL  FMMUL(CTL(LPI22)yCM(LDC) yNPDyNRDyNRCySM(L2) ) 

11810s  CALL  FMADD ( A22 , SM( L2 ) , NPD , NRC , A22 ) 

11820s  2  IF(NDD.EQ.O)  GO  TO  15 

11830s  CALL  MMUL(CTL(LPI11),DM(LEX),NND,NNDfNDD,ZM2) 

11840s  IF(NOEY.EQ.I)  GO  TO  5 

11850s  CALL  FMMUL(CTL(LPI12),DM(LEY),NND,NRD,NDD,ZM1) 

11860s  CALL  MADD1<NND,NDD,ZM1,ZM2,ZM2,1.) 

11870s  5  CALL  TFRMTX(DM(LPHD),ZM1,NDD,NDD,2) 

11880s  CALL  SUBI(ZM1,NDDyNDIM) 

11890s  CALL  AXBMXC(CTL(LPI11),NND,ZM1,NDD,ZM2,A13»SM, 

11900s  1  SM(L2),SM(L3) #SM(L4) ,SM(L5) ) 

11910s  CALL  MMUL(A13,ZM1,NND,NDD,NDD,ZM2) 

11920s  CALL  MADD1(NND,NDD,ZM2,DM(LEX),ZM2,-1.) 

11930s  CALL  FMMUL(CTL(LPI21),ZM2,NPD,NND»NDD,A23) 

11940s  15  NDIMsNPD 
11950s  NDIMIsNDIM+1 

11960s  CALL  MADD1(NPD,NNC,A21,SM(L6),A21,1.) 

11970s  IF(NOEY.EQ.I)  GO  TO  20 

11980s  CALL  MMUL(CTL(LPI22),DM(LEY),NPD,NRD,NDD,ZM1) 

11990s  CALL  MADD1(NPD,NDD,A23,ZM1,A23'-1*) 

12000s  20  CALL  MATLST(A11,NND,NNC,'*A11,,,KLIST) 

12010s  CALL  MATLST(A21,NPD,NNC,"A21",KLIST) 

12020s  CALL  MATLST(A12,NND,NRC,"A12”,KLIST) 

12030s  CALL  MATLST ( A22 , NPD , NRC  f ” A22” , KLIST ) 

12040s  IF(NDD.GT.O)  GO  TO  25 

12050s  WRITE (KLIST* 101 ) 

12060s  101  FORMAT ("OMATRICES  A13  AND  A23  ARB  ZERO" ) 

12070s  RETURN 

12080s  25  CALL  MATLST(A13»NND,NDD,"A13", KLIST) 

12090s  CALL  MATLST(A23,NPD,NDD»"A23"»KLIST) 

12100s  RETURN 

12110sC  END  SUBROUTINE  CGTA 
12120s  END 


12130s  SUBROUTINE  AXBMXC(A,NA,B,NB,C,X,AU,BU,R,Z1,Z2) 

12140s  C0MM0N/MAXN1 /NDIM, NDIH1 ,C0M1 (1 ) 

12150s  COMMON/FILES/KSA VE , KDATA , KPLOT , KLIST , KTERM 

12160=  DIMENSION  A(1 ),B(1 ) ,C( 1 ),X(1 ),AU(1 ),BU(1 ) ,R(1 ),Z1 (1 ),Z2(1 ) 

12170s  DATA  EMAX,ITMAX/1.E-6,3/ 

12180s  CALL  TRANS1 (NA,A,Z1 ) 

12190s  CALL  EIGEN(NA,Z1,Z2,Z2(NDIM1),AU,1) 

12200s  CALL  TRANS1 (NA,C0M1,Z1) 

12210s  CALL  EIGEN(NB,B,Z2,Z2(NDIM1),BU,1) 

12220s  CALL  EQUATE ( R , C , NA , NB ) 

12230s  ITsO 

12240s  10  CALL  MAT4A(AU,R,NA,NA,NB,Z2) 

12250s  CALL  MAT1 (Z2,BU,NA,NB,NB,R) 

12260s  CALL  SLVSHR (Z1, NA, COM 1,NB,R, NDIM) 

12270s  CALL  MAT4(R,BU,NA,NB,NB,Z2) 

12280s  CALL  MAT1 (AU,Z2,NA,NA,NB,R) 

12290s  IF(IT.GT.O)  GO  TO  15 

12300s  CALL  EQUATE(X,R,NA,NB) 

12310s  GO  TO  30 

12320s  15  CALL  MADD1 (NA,NB,X,R,X, 1.) 

12330s  CALL  ENORM(R,NA,NB,EN) 

12340s  IF(EN.LE.EMAX)  RETURN 

12350s  IF(IT.LT.ITMAX)  GO  TO  30 

12360s  WRITE ( KLIST ,101)  EN 

12370s  WRITE(KTERM, 101 )  EN 

12380s  101  FORMAT ("OSOLUTION  ERROR  FOR  *A*(CGT)  AFTER  3  ITERATIONS  s  »,1PE15. 
12390=  17) 

12400=  RETURN 

12410s  30  CALL  MAT1 (A,X,NA,NA,NB,Z2) 

12420s  CALL  MAT1 (Z2,B,NA,NB,NB,R) 

12430s  CALL  MADD1 (NA,NB,X,R,R,-1 •) 

12440s  CALL  MADD1 (NA,NB,R,C,R,1. ) 

12450=  IT=IT+1 

12460s  GO  TO  10 

12470sC  END  SUBROUTINE  AXBMXC 
12480s  END 

12490=  SUBROUTINE  SLVSHR (A, NA,B,NB,C,ND) 

1 2500=  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

12510s  COMMON/I NOU/KIN, KOUT , KPUNCH 

12520s  DIMENSION  A(ND,1),B(ND,1),C(ND,1),V(16),W(4) 

12530s  Lsl 

12540=  5  LM1=L-1 

12550=  DLsI 

12560s  IF(L.EQ.NB)  GO  TO  8 

12570s  IF(B(L+1,L).NE.O.)  DLs2 

12580s  8  LLsLMI+DL 

12590=  Ksl 

12600=  10  KMIsK-1 

12610s  DKsI 

12620s  IF(K.EQ.NA)  GO  TO  12 

12630s  IF(A(K,K+1).NE.O.)  DKs2 

12640s  12  KKsKMUDK 

12650s  AKKsA(K,K) 

12660s  BLLsB(L,L) 

12670s  IF(DL.EQ.2)  GO  TO  35 
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12680s  IF(DK.EQ.2)  GO  TO  20 

12690s  IF(L.EQ.I)  GO  TO  13 

12700s  C(K,L)sC(K»L)-AKK*D0T3(LM1l C(K, 1 ),B( 1 ,L) ) 

12710s  13  IF(K.EQ.I)  GO  TO  18 

12720s  DO  15  Isl.KMI 

12730s  15  C(K,L)sC(K,L)-A(K,I)»DOT3(L,C(I,1),B(1,L)) 

12740s  18  V(1)sAKK»BLL-1. 

12750s  IF(V(1).EQ.O.)  GO  TO  99 

12760s  C(K,L)*C(K,L)/V(1) 

12770s  GO  TO  95 

12780s  20  IF(L.EQ.I)  GO  TO  22 

12790s  IlsK 

12800s  I2sKK 

12810s  I3=LM1 

12820s  GO  TO  24 

12830s  22  IF(K.EQ.I)  GO  TO  30 

12840s  11=1 

12850=  I2=KM1 

12860s  I3=L 

12870=  24  DO  28  1=11,12 

12880=  V(1)sDOT3(I3,C(I,1),B(1,L)) 

12890=  C(K,L)=C(K,L)-A(K,I)»V(1) 

12900s  28  C(KK,L)=C(KK,L)-A(KK,I)»¥(1) 

12910s  IF(II.EQ.K)  GO  TO  22 

12920=  30  V  < 1 )=AKK*BLL-1 • 

12930=  V(2)=A(KK,K)*BLL 

12940=  V(3)*AOCfKK)*BLL 

12950=  V(4)=A(KK,KK)»BLL-1. 

12960=  V(5)=1./(V(1)*V(4)-V(2)*V(3)) 

12970=  V(6)sV(5)«(C(K,L)»V(4)-?(3)»C(KK.L)) 

12980=  C(KK,L)s7{5)*(V(1)*C(KK#L)-7(2)*C(K,L) ) 

12990s  C(K,L)=Y(6) 

13000s  GO  TO  95 

13010=  35  IF(DK.EQ.2)  GO  TO  50 

13020=  IF(L.EQ.I)  GO  TO  38 

13030=  I1=K 

13040=  I2=K 

13050=  I3=LM1 

13060=  GO  TO  40 

13070*  38  XF(K.EQ.I)  GO  TO  45 

13080=  11=1 

13090=  I2*KM1 

13100=  I3*LL 

13110=  40  DO  42  1=11,12 

13120=  C(K,L)«C(K,L)-A(K,I)»DOT3(I3,C(I,1),B(1,L)) 

13130*  42  C(K,LL)*C(K,LL)-A(K,I)»DOT3(I3,C(I,1),B(1,LL)) 

13140=  IF(II.EQ.K)  GO  TO  38 

13150=  45  V(1)*AKK»BLL-1. 

13160=  T(2)=AKK*B(L,LL) 

13170=  V(3)*AKK*B(LL,L) 

13180=  V(4)«AKK*B(LL,LL)-1. 

13190=  48  V(5)«1./(V(1)»V(4)-V(2)»V(3)) 

13200*  V(6)*V(5)#(C(K,L)»V(4)-V(3)*C(K,LL)) 

13210=  C(1C,LL)*V(5)«(V(1)»C(K,LL)-V(2)»C(K,L)) 

13220*  C(K,L)=7(6) 
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GO  TO  95 

IF(L.EQ.I)  GO  TO  55 
V(1)aD0T3(LM1,C(K,1),B(1,L)) 

V(2)aDOT3(LM1 ,C(KK# 1 ),B( 1 ,L) ) 

V(3)*DOT3(LM1 ,C(K,1),B( 1 ,LL) ) 
V(4)=D0T3(LM1,C(KK,1),B(1,LL)) 
C(K,L)=C(K,L)-AKK*V( 1 )-A(K,KK)*V(2) 
C(KK,L)=C(KK,L)-A(KK,K)»V(1)-A(KK,KK)»V(2) 
C(K,LL)aC(K,LL)-AKK*V(3)-A(K,KK)*V(4) 
C(KK,LL)aC(KK,LL)-A(KK»K)*V(3)-A(KK,KK)*V(4) 
IF(K.EQ.I)  GO  TO  65 
DO  60  1=1 ,KM1 

V(1 )*DOT3(LL,C(I# 1)#B( 1,L) ) 

V(2)=D0T3(LL,C(I, 1),B( 1»LL) ) 
C(K,L)=C(K,L)-A(K,I)*V( 1 ) 
C(KK,L)=C(KK,L)-A(KK,I)*V( 1 ) 
C(K,LL)aC(K,LL)-A(K,I)»V(2) 
C(KK,LL)aC(KK,LL)-A(KK,I)*V(2) 

V(1)aAKK«BLL-1. 

V(2)=A(KK,K)*BLL 

V(3)=AKK»B(L,LL) 

V(4)=A(KK,K)*B(L,LL) 

V(5)=A(K,KK)»BLL 

V(6)=A(KK,KK)«BLL-1. 

V(7)»A(K,KK)»B(L,LL) 

V(8)=A(KK,KK)*B(L,LL) 

V(9)sAKK*B(LL»L) 

V ( 10)=A(KKf K)*B(LL#L) 

V(11)aAKK»B(LL,LL)-1. 

V(12)aA(KKfK)»B(LL,LL) 

V(13)aA(K,KK)«B(LL,L) 

V(  14)=A(KK,KK)*B(LL,L) 

V(15)aA(K,KK)»B(LL,LL) 

V(16)=A(KK,KK)*B(LL,LL)-1 • 

W(1)=C(K,L) 

W(2)=C(KK,L) 

H(3)=C(K,LL) 

H(4)=C(KK,LL) 

NDSaNDIM 

NDIM=4 

NDIM1=NDIM+1 

CALL  D00LIT(4,V,W, 1,ISG) 

NDIMaNDS 

NDIMIaNDIM+1 

KaK+DK 

IF(K.LE.NA)  GO  TO  10 
LaL+DL 

IF(L.LE.NB)  GO  TO  5 
RETURN 

WRITE(KOUT.IOI) 

RETURN 

FORMAT ("0*  •  »  ERROR  IN  CGT  SOLUTION:  A11->A23") 

SUBROUTINE  SLVSHR 

END 


a  -> 


■■1^  »  mJ.  mA 
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ft 

13790* 

DIMENSION  A( 1 ) 

13800* 

ENRMaO. 

■ 

13810* 

NE*NC*NDIM 

13820* 

DO  10  1*1, NR 

13830* 

DO  10  J*I,NE,NDIM 

13840* 

10 

ENRM*ENRM+A(J)*A(J) 

13850* 

ENRMsSQRT(ENRM) 

£ 

13860* 

RETURN 

1 

13870*0  end  SUBROUTINE  ENORM  ! 

13880* 

END 

13890* 

SUBROUTINE  CGTKZ(A11,A13,A21,A23,A12,A22,RELA11,RELA12,RELA13,REL) 

:  ‘ 

13900* 

COMMON/MAIN 1 /NDIM, NDIM1 , C0M1  ( 1 ) 

ft 

13910* 

C0M40N/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

13920* 

COMMON/NDIMD/NND , NRD , NPD , NMD , NDD , NHD , NWDD , NPLD, NWPNWD, NNPR 

1 

13930* 

COMMON/ND IMC/NNC , NRC , NPC 

ffp 

JT' • 

13940* 

DIMENSION  A11(1),A13(1),A21(1),A23(1),A12(1),A22(1), 

13950* 

1  RELA11 (1 ),RELA12(1 ),RELA13( 1 ),REL( 1 ) 

$ 

13960* 

NDIM*  NRD 

:V' 

t3970* 

NDIM1.NDIM+1 

£ 

13980* 

CALL  FM1UL(REL,A11,NRD,NND,NNC,RELA11) 

1 

13990* 

CALL  MADD1 (NRD, NNC , RELA1 1 , A2 1 , RELA1 1,1.) 

14000* 

CALL  MATLST ( RELA 1 1 , NRD , NNC , "KXM" , KLIST) 

jl 

14010* 

CALL  MATLST(R£LA 11, NRD, NNC, "KXM", KTERM) 

$ 

14020* 

CALL  FMMUL(REL,A12,NRD,NND,NRC,RELA12) 

$ 

14030* 

CALL  MADD1 (NRD,NRC,RELA12,A22,RELA12, 1.) 

1  o 

14040* 

CALL  MATLST (RELA 12, NRD, NRC , "KXU" , KLIST ) 

14050* 

CALL  MATLST(RBLA12,NRD,NRC, "KXU", KTERM) 

| 

14060* 

IF(NDD.LT.I)  RETURN 

14070* 

CALL  FMMUL(REL,A13,NRD,NND,NDD,RELA13) 

14080* 

CALL  MADD1(NRD,NDD,RELA13,A23,RELA13,1.) 

£ 

14090* 

CALL  MATLST(RELA1 3 , NRD, NDD, "KXN" , KLIST) 

14100* 

CALL  MATLST (RELA 1 3 , NRD , NDD, "KXN" , KTERM) 

pH 

14110* 

RETURN 

14120*0 

END 

SUBROUTINE  CGTKX 

p! 

14130* 

END 

Kj 

14140* 

SUBROUTINE  CEVAL 

R 

14150* 

C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

c3 

14160* 

COMMON/I NOU/KIN, KOUT , KPUNCH 

M 

14170* 

COMMON/D ESIGN/NVCOM,TSAMP , LFLRPI , LFLCGT , LFLKF, LTEVAL, LABORT 

K* 

14180* 

COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

F  ' 

14190* 

COMMON/SYSMTX/NVSM,SM( 1 ) 

ft 

14200* 

COMMON/ZMTX 1 /NVZM, ZM1 ( 1 ) 

§ 

14210* 

C0MM0N/ZMTX2/ZM2O) 

Si 

14220* 

COMMON/NDIMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

14230* 

COMMON/ND IMC/NNC , NRC , NPC 

14240* 

COMMON/LREGPI/LXDW, LUDW, LPHCL, LGC 1 , LGC2, LEL, LEE 

Kf 

14250* 

COMMON/CREGPI/NVRPI , RPI ( 1 ) 

c*. 

14260* 

DIMENSION  NPLOT ( 2 ) , NVPLOT ( 1 0 ) , NS ( 6 ) , LSCL ( 2 ) , ITITLE ( 5 ) 

5 

14270* 

DATA  N0/1HN/ 

B 

14280* 

WRITE (KLIST, 1 10) 

™  •:>>. 

14290* 

110 

F0RMAT(////1 1X,5("*  "), "CONTROLLER  EVALUATION" ,5 ("  •")////) 

V  • v\ 

v  •  \V- 

14300* 

IPOLE* 1 

:.*!• 

‘•V 

14310* 

10 

NVOUT.NRD+NPD+1 

! 
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1 4320«  IF(LFLCGT)  17,17,15 

14330*  15  WRITE  106 
14340*  READ*, IUM, VUM 

14350*  IF(IUM.LT.I)  GO  TO  70 

14360*  IF(IUM.GT.MRC)  GO  TO  15 

14370*  NVOUTsNVOUT+NPC 

14380*  NP*NNC 

14390*  GO  TO  18 

14400*  17  IF(IPOLE.EQ.I)  CALL  P0LES(RPI(LPHCL),NNPR,4,ZM1,ZM2) 

14410*  NPsO 

14420*  18  CALL  VOUTIC(SM, NVPLOT, NPLOT, NVOUT, LSCL) 

14430*  IF(WVOUT.EQ.O)  GO  TO  70 

14440*  20  WRITE  108 

14450*  READ*, TEND 

14460*  IF(TEND)  20,20,25 

14470*  25  LVX0*NV0UT+1 
14480*  LXOsLVXO+NVOUT 

14490*  LX1*LX0+NPLD 

14500*  LXM0=LX1+NPLD 

14510*  LXMlsLXMO+NP 

14520*  NP=LXMUNP 

14530*  DO  26  I*LVXO,NP 

14540*  26  SM(I)*0. 

14550*  CALL  CTRESP(SM(LVX0),SM,SM(LX0),SM(LX1),SM(LXM0),SM(LXM1), 

14560*  1  ZM1, NVOUT, TEND, IUM, VUM, NST) 

14570*  WRITEQCTERM,  101 ) 

14580*  READ(KIN, 102)  ITITLE 

14590*  M»50*NST 

14600=  DO  40  1*1,2 

14610*  NS(1)*1 

14620*  DO  28  J*2,6 

14630*  28  NS(J)*NS(J-1)*51 

14640*  NP*NPLOT(I) 

14650*  IF(NP.EQ.O)  GO  TO  40 

14660*  NPP1*NP+1 

14670*  REWIND  KPLOT 

14680*  NSV*5*I-4 

14690*  CALL  RPLOTF ( ZM 1 , NVOUT , IERR ) 

14700*  CALL  STRPLT (SM, ZM 1 , NS , NVPLOT ( NSV ) , NP , NVOUT ) 

14710*  DO  35  J*1,M 

14720*  CALL  RPL0TF(ZM1, NVOUT, IERR) 

14730*  IF(IERR.EQ.I)  GO  TO  40 

14740*  IF(MOD(J,NST).NE.O)  GO  TO  35 

14750*  DO  30  K*1,NPP1 

14760*  30  NS(K)*NS(K)+1 

14770*  CALL  STRPLT (SM, ZM1, NS, NVPLOT ( NSV ),NP, NVOUT) 

14780*  35  CONTINUE 

14790*  CALL  PLOTLP ( 5 1 , NP , SM, LSCL ( I ) , 1 , 0 , KTERM, ITITLE ) 

14800*  40  CONTINUE 

14810*  NVM* NVOUT -1 

14820*  M*NVM/5 

14830*  NE*5*M 

14840*  IF(M.EQ.O)  GO  TO  56 

14850*  DO  55  I*1,NE,5 

14860*  NS(1)*1 
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14870*  DO  42  J*2,6 

14880*  42  NS(J)*NS(J-1)+101 

14890*  REWIND  KPLOT 

14900*  NVS.I-1 

14910*  DO  45  J*1,5 

14920*  45  NVPLOT(J)*NVS+J 

14930*  DO  50  J*1,101 

14940*  CALL  RPL0TP(ZM1, NVOUT, IERR) 

14950*  IF(IERR.EQ.I)  GO  TO  55 

14960*  CALL  STRPLT ( SM, ZM1 , NS , NVPLOT , 5 , NVOUT ) 

14970*  DO  48  K*1,6 

14980*  48  NS(K)*NS(K)*1 

14990*  50  CONTINUE 

15000*  CALL  PLOTLP( 101 ,5»SM, 1, 1, 1 ,KLIST,ITITLE) 

15010*  55  CONTINUE 

15020*  56  NVM*NVM-NE 

15030*  IF(NVM.LT.I)  GO  TO  70 

15040*  NPP1*NVH*1 

15050*  NS( 1 )*1 

15060*  DO  57  1*2,6 

15070*  57  NS(I)*NS(I-1)+101 

15080*  DO  58  1*1, NVM 

15090*  58  NVPLOT(I)*NE+I 

15100*  REWIND  KPLOT 

15110*  DO  65  1*1,101 

15120*  CALL  RPL0TFCZM1, NVOUT, IERR) 

15130*  IF(IERR.EQ.I)  GO  TO  70 

15140*  CALL  STRPLT(SM,ZM1, NS, NVPLOT, NVM, NVOUT) 

15150*  DO  60  J*1,NPP1 

15160*  60  NS( J)*NS( J)+1 

15170*  65  CONTINUE 

15180*  CALL  PLOTLP( 101, NVM, SM, 1,1, 1,KLIST, ITITLE) 

15190*  70  WRITE  104 

15200*  READ  111, IANS 

15210*  IF(IANS.EQ.NO)  RETURN 

15220*  IPOLEsO 

15230*  GO  TO  10 

15240*  101  FORMATS  10 "  ENTER  TITLE  IN  GIVEN  FIELD  ",  IOC-**),  "♦"/) 
15250*  102  F0RMATC5A10) 

15260*  104  FORMAT ("OMORE  TIME  RESPONSE  RUNS  (T  OR  N)  >") 

15270*  106  FORMAT( "OENTER  MODEL  INPUT  AND  STEP  VALUE  :  1  >") 

15280*  108  FORMAT (■  ENTER  TIME  DURATION  FOR  RESPONSE,  IN  SECONDS  >") 


I 


15290*  111  F0RMAT(A3) 

15300*C  END  SUBROUTINE  CEVAL 

15310*  END 

15320*  SUBROUTINE  VOUTIC(VIC, NVPLOT, NPLOT, NVOUT, LSCL) 

15330*  COMMON/D ESIGN/NVCOM , TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL, LABORT 

15340*  COMMON/FILES/KSAVE , KDATA , KPLOT , KLIST , KTERM 

15350*  COMMON/ND IMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 


15360*  COMMON/NDIMC/NNC , NRC , NPC 

15370*  COMMON/ND IMT/NNT, NRT, NMT, NWT 

15380*  DIMENSION  NPL0T(1),NVPL0T(1),VIC(1),I0UT(5),LSCL(2) 

15390*  DATA  I0UT/1HX, 1HY, 1HU, 1HM, 1HD/ 

15400*  IF (LTEVAL)  2,2,5 

15410*  2  NVSiNND 


15420>  NVsNPLD 

15430s  GO  TO  8 

15440s  5  NVsNMT 

15450s  NVSsNV 

15460s  8  NVOUTsNVOUT+NV 

15470s  DO  9  I*1,NV0UT 

15480s  9  VIC(I)s0. 

15490s  NVUsNV+NPD 

15500s  NVM*NVU+NRD 

15510s  10  WRITE  101, NVS 

15520s  101  FORMAT ( "OENTER  STATE  AND  IC  VALUE  (0/  TERMINATES):  ",I2,"  >") 

15530*  12  READ»,IV,V 

15540*  IP(IV.LT.I)  GO  TO  15 

15550*  IP(IV.GT.NVS)  GO  TO  10 

15560*  VIC(IV)*V 

15570*  GO  TO  12 

15580*  15  IP((LPLCGT.LT.1).0R.(LTEVAL.EQ.1).0R.(NDD.LT.1))  GO  TO  25 

15590*  LD*1 

15600*  18  WRITE  102, NDD 

15610*  102  FORMAT ("  ENTER  DISTURBANCE  IC  VALUE  (0/  TERMINATES):  ",I2,"  >") 

15620*  20  READ*, IV, V 

15630*  IF(IV.LT.I)  GO  TO  26 

15640*  IF(IV.GT.NDD)  GO  TO  18 

15650*  VIC(NND+IV)*V 

15660*  GO  TO  20 

15670*  25  LD*0 

15680*  26  WRITE  103 

15690*  103  FORMAT<"  2  PLOTS  OF  5  VARIABLES  MAT  BE  PRINTED  AT  THE  TERMINAL  — 
15700*  1 SPECIFY  NUMBER  FOR  EACH  (N1,N2>  >■) 

15710*  READ*,NPLOT( 1 ),NPL0T(2) 

15720*  IF(NPL0T(1).GT.5)  NPL0T(1)*5 

15730*  IF(NPL0T(2).GT.5)  NPL0T(2)*5 

15740*  IF( (NPLOT( 1 ) .GT.O) .OR. (NPL0T(2) .GT.O) )  GO  TO  27 

15750*  NV0UT.0 

15760*  RETURN 

15770*  27  WRITE  104 

15780*  104  FORMAT ("  ENTER  OUTPUTS  BY  TYPE  AND  INDEX  IN  2  ENTR IES— -TYPES  ARE"/ 
15790*  1  "  STATE  :  »X’"/"  OUTPUT  :  ’Y’"/»  INPUT  :  *U»") 

15800*  IF(LFLCGT)  30,30,28 

15810*  28  WRITE  105 

15820*  105  FORMAT ("  MODEL  :  *M»") 

15830*  IF(LD.EQ.I)  WRITE  106 

15840*  106  FORMAT ("  DISTURBANCE  :  *D'") 

15850*  30  DO  40  1*1,2 

15860*  NCsNPLOT(I) 

15870*  IF(NC.LT.I)  GO  TO  40 

15880*  LSCL(I)*1 

15890*  NS*5*(I-1 ) 

15900*  WRITE  107,1 

15910*  107  FORMAT ("OPLOT  ",I2) 

15920*  DO  39  J*1,NC 

15930*  NSPsNS+J 

15940*  31  WRITE  108, J 

15950*  108  FORMAT ("  OUTPUT  ",I2,"  >") 

15960*  READ  111, IV 


15970*  WRITE  113 

15980*  113  F0RMAT(11X,">") 

15990*  READ* , 10 

16000*  IF ( IV • NE . I0UT ( 1 ) )  GO  TO  32 

16010*  IF(IO.GT.NVS)  GO  TO  38 

16020*  NVPLOT (NSP)* 10 

16030*  GO  TO  39 

16040*  32  IF(IV.NE.I0UT(2))  GO  TO  321 

16050*  IF(IO.GT.NPD)  GO  TO  38 

16060*  NVPLOT ( NSP )*NV+IO 

16070*  GO  TO  39 

16080*  321  IF(IV.NE.I0UT(3))  GO  TO  33 

16090*  IF(IO.GT.NRD)  GO  TO  38 

16100*  NVPLOT ( NSP ) *  NVU+IO 

16110*  GO  TO  39 

16120*  33  IF(LPLCGT.LT.I)  GO  TO  31 

16130*  IF(IV.NE.I0UT(4))  GO  TO  34 

16140*  IF(IO.GT.NPC)  GO  TO  38 

16150*  NVPLOT(NSP)*NVM+IO 

16160*  LSCL'I)*-1 

16170*  GO  TO  39 

16180*  34  IF(LD.NE.I)  GO  TO  31 

16190*  IF(IV.NE.I0UT(5))  GO  TO  31 

16200*  IF(IO.GT.NDD)  GO  TO  38 

16210*  NVPLOT ( MSP )*NVS+IO 

16220*  GO  TO  39 

16230*  38  WRITE  109 

16240*  109  FORMAT ("  INDEX  TOO  LARGE*) 

16250*  GO  TO  31 

16260*  39  CONTINUE 

16270*  40  CONTINUE 

16280*  NVMUNVOUT-1 

16290*  NP*0 

16300*  DO  50  1*1 » NVM1 

16310*  M*MOD( (1-1 )»5)+1 

16320*  IF(M.GT.I)  GO  TO  41 

16330*  NPsNP+1 

16340*  WRITE (KLIST, 110)  NP 

16350*  110  FORMAT (*OPLOT  *,I2) 

16360*  41  IF(I.GT.NVS)  GO  TO  42 
16370*  IV*I0UT(1 ) 

16380*  10*1 

16390*  GO  TO  45 

16400*  42  IF(I.GT.NV)  GO  TO  43 

16410*  IV*I0UT(5) 

16420*  IOxI-NVS 

16430*  GO  TO  45 

16440*  43  IF(I.GT.NVU)  GO  TO  441 

16450*  IV*I0UT(2) 

16460*  IOsI-NV 

16470*  GO  TO  45 

16480*  441  IF(I.GT.NVM)  GO  TO  44 

16490*  IV*I0UT(3) 

16500*  IO*I-NVU 

16510*  GO  TO  45 
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16520s  44  IV*I0UT(4) 

16530s  IOsI-NVM 

16540s  45  WRITE (KLIST, 112)  M,IV,IO 

16550s  50  CONTIHUE 

16560s  RETURN 

16570s  111  FORMAT(AI) 

16580s  112  FORMAT ("  OUTPUT  »,I 2,»:  ",A1,I2) 

16590sC  END  SUBROUTINE  VOUTIC 

16600s  END 

16610s  SUBROUTINE  CTRESP(VX0,YX1, XO,X1,XMO,XM1,ZM1,NVOUT,TEND,IUM,VUM, 

16620s  1  NST) 

1 6630s  COMMON/DESIGN/NVCOM, TSAMP, LFLRPI, LFLCGT, LFLKF, LTEVAL, LABORT 

1 6640s  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

1 6650s  C0W10N/NDIMD/NMD, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD , NNPR 

1 6660s  COMMON/LOCD/LAP, LGP , LPHI , LBD , LEX , LPHD , LQ , LQN , LQD, LC,LDY, LET, LHP , LR 

1 6670s  COMKON/DSNMTX/NVDM, NODT, NOET, DM( 1 ) 

16680s  COMMON/ND IMC/NNC , NRC , NPC 

16690s  COMMON/LOCC/L  PHC , LBDC , LCC , LDC 

1 6700s  COMMON/CMDMTX/NVCM, NEVCM, NODC , CM( 1 ) 

1 6710s  COMMON/LOCT/LPHT, LBDT, LQDT, LHT, LRT,LTDT, LTNT 

1 6720s  COMMON/TRUMTX/NVTM, TM( 1 ) 

1 6730s  COMMON/LREGPI/LXDV , LUDV , LPHCL, LGC 1 , LGC2, LEL, LEE 

16740s  C0MM0N/CREGPI/NVRPI,RPI(1) 

16750s  DIMENSION  VX0(1 ), VX1 (1 ),X0( 1 ),X1 ( 1 ),XMO( 1 ),XM1 ( 1 ),ZM1 ( 1 ) 

16760s  NSTPOs  .01  *TEND/TSAMP-f .  5 

16770s  NSTs2 

16780s  IF ( NSTPO  *  GE • 1 )  GO  TO  1 

16790s  NSTPOs 1 

16800s  NSTsI 

16810s  1  NSTEPSs 1 00*NSTP0 

16820s  IF(LFLCGT.EQ.O)  GO  TO  2 

16830s  LMOsNTOUT-NPC 

16840s  IF(NDD.EQ.O)  GO  TO  4 

16850s  LDCGTsI 

16860s  GO  TO  5 

16870s  2  LMOsNVOUT 

16880s  4  LDCGTsO 

16890s  5  LUsLMO-NRD 

16900s  LSOsLU-NPD 

16910s  NVXsLSO-1 

16920s  IF(LTEVAL)6, 6, 10 

16930s  6  DO  7  Is1,NTX 

16940s  7  XKl)sVXI(I) 

16950s  GO  TO  12 

16960s  10  CALL  XFDT(YX1,X1,LDCGT) 

16970s  12  NNDPIsNND^I 

16980s  REWIND  KPLOT 

16990s  CALL  TDSN(X1,VX1 (LU),DM(LC),DM(LDY),LDCGT,VX1 (LSO) ) 

17000s  IF(LFLCGT.EQ.I)  CALL  TCMD(XM1,IUM,VUM,CM(LCC),CM(LDC), 

17010s  1  VX1 (LMO) ) 

17020s  CALL  WPL0TF(YX1 ,NV0UT) 

17030s  DO  100  ITsI ,NSTEPS 

17040s  CALL  URPI(RPI(LGC1),RPI(LGC2),DM(LC),DM(LDY),X0,X1,VX0(LU), 

17050s  1  VXI(LU)) 

17060s  IF(LFLCGT)  20,20,15 


17070*  15  CALL  UCGT(7X0(LU),7X1 (LU),XM0,XM1,X0(NNDP1 ),ZM1,IUM,7UM,IT) 

17080s  CALL  CUPDAT(XM0,XMl,IUM,7UM) 

17090s  20  CALL  FTMTX(7X1 (LU),7X0(LU),NRD, 1 ) 

17100s  CALL  FTMTX(X1,X0,NPLD,1) 

17110s  IF(LTEVAL)  25,25,30 

17120s  25  CALL  DUPDAT(DM(LPHI) ,DM(LBD) ,DM(LPHD) ,DM(LEX),X0,X1 , 

17130s  1  7X 1, 7X0 (LU), LDCGT, NNDP1 ) 

17140s  GO  TO  35 

17150s  30  CALL  TUPDAT(TM(LPHT) ,TM(LBDT),7X0,7X1 ,7X0(LU) ) 

17160s  CALL  XFDT ( VX 1 , X 1 , LDCGT ) 

17170s  35  IF(MOD(IT,NSTPO) .NE.O)  GO  TO  100 

17180s  7X1 (N70UT)sTSAMP*FL0AT(IT) 

17190s  CALL  YDSN(X1 ,7X1 (LU) ,DM(LC) ,DM(LDY) , LDCGT, 7X1 (LSO) ) 

17200s  IF(LFLCGT.EQ.I)  CALL  YCMD(XM1,IUM,7UM,CM(LCC),CM(LDC), 

17210s  1  7X1 (LMO)) 

17220s  CALL  WPLOTF (7X1, N70UT ) 

17230s  100  CONTINUE 

17240s  ENDFILE  KPLOT 

17250s  RETURN 

17260sC  END  SUBROUTINE  CTRESP 

17270s  END 

17280s  SUBROUTINE  DUPDAT(PHI,BD,PHID,EX,X0,X1 ,7X1 , UO, LDCGT, NNDP1 ) 

17290s  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

1 7300s  COMMON/NDIMD/NND, NRD, NPD, NMD, HDD, NWD, NWDD, NPLD, NWPNWD , NNPR 

17310s  DIMENSION  PHI(1 ),BD( 1 ),PHID( 1),EX(l),X0(l),X1(l),7X1(l),U0(l) 

17320s  NDIMsNND 

17330s  NDIMlsNDIM+1 

17340s  CALL  FMMUL(BD,UO,NND,NRD, 1,X1 ) 

17350s  CALL  MMULS(PHI,X0,NND,NND,1,X1) 

17360s  IF(LDCGT.EQ.O)  GO  TO  10 

17370s  CALL  FJMUL(PHID,X0(NNDP1),NDD,NDD,1,X1(NNDP1)) 

17380s  CALL  MMULS(EX,X1 (NNDP1 ),NND,NDD, 1 , XI ) 

17390s  10  CALL  FTMTX(X1, 7X1, NPLD, 1) 

17400s  RETURN 

17410sC  END  SUBROUTINE  DUPDAT 

17420s  END 

17430s  SUBROUTINE  CUPDAT(XM0,XM1,IUM,7UM) 

1 7440s  C0MM0N/MAIN1 /NDIM, NDIMl , COM! ( 1 ) 

17450s  COMMON/NDIMC/NNC , NRC , NPC 

17460s  COMMON/LOCC/LPHC , LB DC , LCC , LDC 

1 7470s  C0MM0N/CMDMTX/N7CM, NEVCM, NODC , CM( 1 ) 

17480s  DIMENSION  XM0(1),XM1(1) 

17490s  NDIMsNNC 

17500s  NDIMl sNDIM+1 

17510s  CALL  FTMTX(XM1,XM0,NNC,1) 

17520s  L1sLADDR(NNC, 1,IUM)+LBDC-1 

17530s  CALL  7SCALE(XM1 ,CM(L1 ) , NNC, 7UM) 

17540s  CALL  MMULS(CM(LPHC) ,XMO,NNC,NNC, 1,XM1 ) 

17550s  RETURN 

17560sC  END  SUBROUTINE  CUPDAT 

17570s  END 

17580s  SUBROUTINE  TUPDAT(PHI,BD,7X0,7X1 ,U0) 

1 7590s  C0MM0N/MAIN1 /NDIM, NDIMl ,C0M1 ( 1 ) 

17600s  COMMON/NDIMT/NNT,NRT,NMT,NWT 

17610s  DIMENSION  PHI( 1 ),BD< 1 ) , 7X0 < 1 ),7X1 ( 1 ) , UO ( 1 ) 
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17620s  NDIMsNNT 

17630s  NDIMlsNDIM+1 

17640s  CALL  FTMTX(VX1,VX0,NNT,1) 

17650s  CALL  FMMUL(BD,U0,NNT,NRT,1,VX1) 

17660s  CALL  MMULS(PHI,VXO,NNT,NNT, 1,VX1 ) 

17670s  RETURN 

17680sC  END  SUBROUTINE  TUPDAT 

17690s  END 

17700s  SUBROUTINE  XFDT(V,X,LDCGT) 

17710s  COMMON/ND IMD/NND , NRD, NPD, NMD, NDD, NWD, NWDD , NPLD , NWPNWD , NNP R 

17720s  COMMON/ND IMT/NNT,  NRT, NMT, NUT 

1 7730s  COMWN/LOCT/LPHT ,  LBDT ,  LQDT ,  LHT ,  LRT ,  LTDT ,  LTNT 

1 7740s  COMMON/TRUKTX/NVTM, TM( 1 ) 

17750s  DIMENSION  V(1),X(1) 

17760s  CALL  FMMUL(TM(LTDT) , V,NND,NNT, 1 ,X) 

17770s  IF(LDCGT.EQ.O)  RETURN 

17780s  CALL  FMMUL(TM(LTNT), V,NDD,NNT, 1,X(NND*1 )) 

17790s  RETURN 

17800sC  END  SUBROUTINE  XFDT 

17810s  END 

17820s  SUBROUTINE  URPI(RGC1,RGC2,C,DY,X0,X1,U0,U1) 

1 7830s  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

1 7840s  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

17850s  DIMENSION  RGC1 (1 },RGC2(1 ),C( 1),DY(1),X0(1),X1(1),U0(1),U1(1) 

17860s  CALL  YDSN(X0,U0,C,D¥,0,U1 ) 

17870s  10  CALL  VSCALE(U1,U1,NRD,-1.) 

17880s  CALL  MMULS(RGC2,U1 , NRD, NRD, 1,U0) 

17890s  DO  12  Is 1, NPLD 

17900s  12  X0(I)sX0(I)-X1(I) 

17910s  CALL  FMMUL(RGC1 ,XO,NRD,NND, 1,U1) 

17920s  CALL  VADD(NRD,1.,U1,U0) 

17930s  RETURN 

17940sC  END  SUBROUTINE  URPI 

17950s  END 


17960s 

17970s 

17980s 

17990s 

18000s 

18010s 

18020s 

18030s 

18040s 

18050s 

18060s 

18070s 

18080s 

18090s 

18100s 

18110s 

18120s 

18^308 

I6i40s 

18150s 


SUBROUTINE  UCGT(U0,U1,XM0,XM1,DDIF,ZM1,IUM,VUM,IT) 

C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 
COMMON/ND IMC/NNC , NRC , NPC 
COMMON/LOCC/LPHC, LBDC, LCC, LDC 
COMMON/CMDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

COMMON/LREGPI/LXDW, LUDW , LPHCL, LGC 1 , LGC2 , LEL , LEE 
COMMON/CREGPI/NVRPI , RPI ( 1 ) 

COMMON/LCGT/L A 1 1 , LA 1 3 , LA2 1 , LA23 , LA 1 2 , LA22 , LELA 11 , LELA 1 2 , LELA 1 3 
COMMON/CCGT/NVCGT,CGT( 1 ) 

DIMENSION  U0(1),U1(1), XMO (1),XM1(1), DDIF ( 1 ) , ZM1 ( 1 ) 

CALL  YCMD ( XMO , IUM, VUM, CM( LCC ) , CM( LDC ) , UO ) 

IF(IT.GT.I)  GO  TO  10 

IsLELA 1 2+LADDR (NPD, 1, IUM) -1 

CALL  MADD1 (NPD, 1 ,U1 ,CGT(I),U1 ,VUM) 

10  CALL  MMULS ( RPI (LGC2),U0, NDIM, NDIM, 1 ,U1 ) 

DO  12  Is1,NNC 
12  XMO(I}sXMl (I)-XMO(I) 

CALL  FMMUL(CGT (LELA 1 1 ) , XMO , NPD, NNC , 1 , UO ) 

CALL  VADD(NDIM,1.,U1,U0> 
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18160*  IF(NDD.EQ.O)  RETURN 

18170*  DO  14  1*1, NDD 

18180*  14  DDIF ( I ) * -DDIF ( I ) 

18190*  CALL  MMULS(CGT(LELA13),DDIF,NPD,NDD,1,U1) 

18200*  RETURN 

18210*C  END  SUBROUTINE  UCGT 
18220*  END 

18230*  SUBROUTINE  YDSN(X,U,C,D,LDCGT, Y) 

18240*  COMMON/MAIN1/NDIM,NDIM1,COM1 (1 ) 

1 8250*  COMMON/ND IMD/NND , NRD , NPD , NMD , NDD , NWD , NVDD , NPLD , NWPNWD , NNPR 

1 8260*  COHHON/LOCD/LAP, LGP, LPHI, LBD, LEX, LPHD, LQ, LQN, LQD, LC, LDY, LEY, LHP, LR 

1 8270*  COMMON/DSNMTX/NVDM, NODY, NOEY, DM( 1 ) 

18280*  DIMENSION  X(1 ),U( 1 ),C( 1 ),D( 1 ), Y(1 ) 

18290*  NDIM*NPD 

18300*  NDIM1*NDIM+1 

18310*  CALL  FMMUL(C,X,NPD,NND,1,Y) 

18320*  IF(NODY.EQ.I)  GO  TO  10 

18330*  CALL  MMULS(D,U,NPD,NRD, 1,Y) 

18340*  10  IF( (LDCGT.EQ.O) .OR. (NOEY.EQ. 1 ) )  RETURN 
18350*  CALL  MMULS(DM(LEY) , X(NND+1 ), NPD, NDD, 1 ,Y) 

18360*  RETURN 

18370*C  END  SUBROUTINE  YDSN 

18380*  END 

18390*  SUBROUTINE  YCMD(X,IU,VU,C,D, Y) 

18400*  C0MM0N/MAIN1/NDIM, NDIM1 ,C0M1 ( 1 ) 

18410*  COMMON/NDIMC/NNC,NRC,NPC 

1 8420*  COMMON/CMDMTX/NVCM, NEWCM, NODC , CM( 1 ) 

18430=  DIMENSION  X( 1 ),C( 1 ),D( 1 ), Y( 1 ) 

18440=  NDIM.NPC 

18450*  NDIM1=NDIM+1 

18460=  CALL  F»MUL(C,X,NPC,NNC, 1,Y) 

18470*  IF(NODC.EQ.I)  RETURN 

18480*  L1*LADDR(NPC, 1 ,IU) 

18490*  CALL  MADD1 (NPC, 1 , Y,D(L1 ) , Y, VU) 

18500*  RETURN 

18510=C  END  SUBROUTINE  YCMD 
18520*  END 

18530*  SUBROUTINE  FLTRK(IFLTR) 

18540*  C0MM0N/MAIN1/NDIM,NDIM1,C0M1 (1 ) 

1 8550*  C0MM0N/MAIN2/C0M2 ( 1 ) 

18560*  COMMON/DESIGN/NVCOM , TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL , LABORT 

1 8570*  COMMON/FILES/KSAVE , KDATA , KPLOT , KLIST , KTERM 

1 8580*  COMMON/SYSMTX/NVSM, SM( 1 ) 

18590*  C0MM0N/ZMTX1/NVZM,ZM1<1) 

18600*  C0MM0N/ZMTX2/ZM2(1) 

18610*  COMMON/ND IMD/NND , NRD , NPD , NMD , NDD , NVD , NVDD , NPLD , NWPNWD , NNPR 

1 8620*  C0M40N/L0CD/LAP, LGP , LPHI, LBD, LEX, LPHD, LQ, LQN, LQD, LC, LDY, LEY, LHP , LR 

18630*  COMMON/DSNMTX/NVDM, NODY, NOEY,DM( 1 ) 

1 8640*  COMMON/LKF/LEADSN, LFLTRK , LFCOV 

1 8650*  COMMON/CKP/NVPLT , FLT ( 1 ) 

18660*  IF ( NWPNWD .GT.O)  GO  TO  1 

18670*  WRITE(KTERM, 108) 

18680*  108  FORMAT("ONO  DRIVING  NOISES  -  -  FILTER  DESIGN  ABORT**) 

18690*  RETURN 

18700*  1  IF(NMD.GT.O)  GO  TO  2 
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18710=  WRITE (KTERM, 109) 

18720=  109  FORMAT("ONO  MEASUREMENTS  -  -  FILTER  DESIGN  ABORT") 

18730=  RETURN 

18740=  2  WRITE(KLIST, 1 10) 

18750=  110  F0RMAT(////11X,5("«  "), "FILTER  DESIGN", 5("  *")////) 
18760=  NSIZE=NPLD#( 1+NPLD+NMD) 

18770=  IF ( NSIZE . LE . NVFLT )  GO  TO  3 

18780=  WRITE  101, NSIZE 

18790=  101  FORMAT ("OINSUFFICIENT  MEMORY  /CKF/ ,  NEED:  ",I4) 

18800=  LABORTsNSIZE 

18810=  RETURN 

18820=  3  NDIM=NPLD 

18830=  NDIM1=NDIM+1 

18840=  5  IF(NWD.EQ.O)  GO  TO  12 

18850=  IF(IFLTR.LE.O)  GO  TO  6 

18860=  WRITE  105,NWD 

18870=  105  FORMAT ("  ENTER  STATE  NOISE  STRENGTHS:  ",I2) 

18880=  CALL  RQWGTS (DM(LQ), NWD , 0 ) 

18890=  6  CALL  DVCTOR(NWD,DM(LQ),ZMl ) 

18900=  CALL  MATLST (ZM1, NWD, 1,"Q", KTERM) 

18910=  10  CALL  MATLST(DM(LQ) , NWD, NWD, "Q" ,KLIST) 

18920=  12  IF(NWDD.EQ.O)  GO  TO  18 

18930=  IF(IFLTR.LE.O)  GO  TO  13 

18940=  WRITE  106,NWDD 

18950=  106  FORMAT ( "  ENTER  DISTURBANCE  NOISE  STRENGTHS:  ",I2) 
18960=  CALL  RQWGTS(DM(LQN) ,NWDD,0) 

18970=  13  CALL  DVCTOR(NWDD,DM(LQN) ,ZM1 ) 

18980=  CALL  MATLST (ZM1,NWDD,1,"QN", KTERM) 

18990=  15  CALL  MATLST (DM(LQN), NWDD , NWDD , "Q N" , KLIST ) 

19000=  18  CALL  QDSCRT(DM(LQ),DM(LQN),ZM1,ZM2) 

19010=  IF(IFLTR.LE.O)  GO  TO  19 

19020=  WRITE  107, NMD 

19030=  107  FORMAT ("  ENTER  MEASUREMENT  NOISE  STRENGTHS:  ",I2) 
19040=  CALL  RQWGTS(DM(LR),NMD,0) 

19050=  19  CALL  DVCT0R(NMD,DM(LR),ZM1) 

19060=  CALL  MATLST(ZM1, NMD, 1,"R", KTERM) 

19070=  20  CALL  MATLST(DM(LR), NMD, NMD, "R", KLIST) 

19080=  25  CALL  TFRMTX(DM(LHP) ,SM,NMD,NDIM,2) 

19090=  CALL  TRANS2(NMD,NDIM,SM,ZM1) 

19100=  LFCOV=LFLTRK+NDIM*NMD 

19110=  CALL  DVCTOR(NMD,DM(LR) ,FLT(LFCOV) ) 

19120=  CALL  KFLTR(NDIM,NMD,FLT,ZM1,DM(LQD) ,FLT(LFC0V),ZM2, 

19130=  1  FLT(LFLTRK),SM) 

19140=  CALL  TFRMTX (SM, COM2 , NDIM, NDIM, 2 ) 

19150=  IA=1 

19160=  DO  30  Isl.NPLD 

19170=  FLT(LFC0V-1+I)=SQRT(ZM2(IA) ) 

19180=  30  IAsIA+NDIMl 

19190=  CALL  MATLST (FLT(LFLTRK),NDIM, NMD, "KF", KLIST) 

19200=  CALL  MATLST(FLT(LFLTRK),NDIM, NMD, "KF", KTERM) 

19210=  IFLTR* 1 

19220=  LFLKFsl 

19230=  111  FORMAT (A3) 

19240=  RETURN 

19250*C  END  SUBROUTINE  FLTRK 


19260s  END 

19270s  SUBROUTINE  FEVAL 

1 9280s  C0MM0N/MAIN1 /NDIM, NDIM1 ,C0M1 ( 1 ) 

1 9290s  COMMON/MAIN2/COM2 ( 1 ) 

19300s  COMMON/INOU/KIN, KOUT, KPUNCH 

19310s  COMMON/DESIGN/NVCOM,TSAMP,LFLRPI,LFLCGT,LFLKF,LTEVAL,LABORT 

1 9320s  COMMON/FILES/KSAVE, KDATA , KPLOT , KLIST , KTERM 

1 9330s  COMMON/SYSMTX/NVSM, SM( 1 ) 

19340s  C0MM0N/ZMTX1 /NVZM, ZM1 ( 1 ) 

19350s  C0MM0N/ZMTX2/ZM2 ( 1 ) 

19360s  COMMON/ND IMD/NND, NRD,NPD,NMD,NDD,NWD, NWDD , NPLD , NWPNWD , NNPR 

19370s  COMMON/LOCD/LAP , LGP , LPHI , LBD , LEX , LPHD , LQ , LQN , LQD , LC , LDY , LEY , LHP , LR 

19380s  COMMON/DSNMTX/NVDM, NODY, NOEY,DM( 1 ) 

19390s  COMMON/ND IMT/NNT, NRT, NMT, NWT 

1 9400s  COMMON/LOCT/LPHT, LBDT, LQDT, LHT, LRT, LTDT, LTNT 

19410s  COWiON/TRUMTX/NVTM, TM( 1 ) 

1 9420s  COMMON/LKF/LEADSN, LFLTRK , LFCOV 

19430s  COMMON/CKF/NVFLT, FLT ( 1 ) 

19440s  DIMENSION  ITITLE(5),NS(3),NVPL0T(2) 

19450s  IF(NHT.GT.O)  GO  TO  1 

19460s  WRITE(KTERM, 108) 

19470s  108  FORMAT ("ONO  TRUTH  MODEL  DRIVING  NOISE  -  -  FILTER  EVALUATION  ABORTE 
19480s  ID") 

19490s  RETURN 

19500s  1  WRITE ( KLIST  *110) 

19510s  110  F0RMAT(////1 1X,5("*  "), "FILTER  EVALUATION" , 5 ( "  •")////) 

19520s  CALL  FMMUL( COM2, FLT (LEADSN), NPLD, NPLD, NPLD, SM) 

19530s  CALL  P0LES(SM, NPLD, 5, ZMl , ZM2 ) 

19540s  NAsNNT+NPLD 

19550s  NSIZEsNA*NA 

19560s  IF(NSIZE.LE.NVSM)  GO  TO  8 

19570s  WRITE  101,NSIZE 

19580s  101  FORMAT ("OINSUFFICIENT  MEMORY  /SYSMTX/,  NEED:  ",I4) 

19590s  GO  TO  9 

19600s  8  IF ( NSIZE . LE . NVZM)  GO  TO  10 
19610s  WRITE  103, NSIZE 

19620s  103  FORMAT ("OINSUFFICIENT  MEMORY  /ZMTX 1 / , /ZMTX2/ ,  NEED:  ",I4) 

19630s  9  LABORTs NSIZE 

19640s  RETURN 

19650s  10  CALL  ZPART(SM,1, NSIZE, 1) 

19660s  NDIM* NPLD 

19670s  NDIMlsNDIM+1 

19680s  CALL  TFRMTX(TM(LRT),ZM1,NMD,NMD,2) 

19690s  CALL  MAT3 ( NPLD , NMD , FLT ( LFLTRK ) , ZMl , COM 1 ) 

19700s  NV0UTs2»NPLD+1 

19710s  REWIND  KPLOT 

19720*  CALL  DACOV (SM, FLT (LFCOV), ZMl, ZM2 , NA , NVOUT , 0 • ) 

19730s  DO  20  IT* 1,50 

19740*  TIME*TSAMP»FLOAT(IT) 

19750*  CALL  ACOVUD (SM, TM( LQDT ) , C0M1 , TM( LPHT ) , FLT ( LEADSN) , 

19760*  1  COM2, ZMl, ZM2) 

19770*  CALL  DACOV ( SM, FLT ( LFCOV ) , ZM 1 , ZM2 , NA , NVOUT , TIME ) 

19780s  20  CONTINUE 
19790*  ENDFILE  KPLOT 

19800*  WRITE(KTERM, 104) 


19810*  READ(KIN, 102)  ITITLE 

19820*  DO  50  1=1, NPLD 

19830*  REWIND  KPLOT 

19840*  NS( 1 )*1 

19850*  NS(2)*52 

19860*  NS(3)*103 

19870*  NVPL0T( 1 )*I+I-1 

19880*  NVPL0T(2)*I>I 

19890*  DO  40  J*1,51 

19900*  CALL  RPLOTF (ZMl, NVOUT , IERR ) 

19910*  IF(IERR.EQ.I)  GO  TO  50 

19920*  CALL  STRPLT (SM, ZH1 , NS, NVPLOT, 2, NVOUT) 

19930*  DO  35  K*1,3 

19940*  35  NS(K)*NS(K)+1 

19950*  40  CONTINUE 

19960*  WRITE  107 »  ZMl (NVPLOT ( 1 ) ) ,  I , ZMl (NVPLOT ( 2 ) ) 

19970=  107  FORMAT ( "OFINAL  RMS  ERRORS  :  TRUE  *  ",1PE15.7/"  (STATE", 13 
19980*  1  ")",4X, "COMPUTED  *  ",1PE15.7) 

19990*  CALL  PL0TLP(51,2,SM,-1 , 1,0,KLIST, ITITLE) 

20000*  WRITE(KLIST,106)  I 

20010*  106  FORMAT ("0  STATE  :  ",I2//4X, "SYMBOL  1  :  TRUE  ERROR"/ 
20020*  1  4Xf "SYMBOL  2  :  COMPUTED  ERROR  "/) 

20030*  50  CONTINUE 

20040*  RETURN 

20050*  104  FORMAT ("  4.",lO("-»),"  ENTER  TITLE  IN  GIVEN  FIELD  ",10("-") 
20060*  102  F0RMAT(5A10) 

20070=C  END  SUBROUTINE  FEVAL 

20080*  END 

20090=  SUBROUTINE  DAC0V(PCA,PC,ZM1 ,ZM2,NA,NV0UT,TIME) 

20100=  C0MM0N/MAIN1/NDIM,NDIM1,C0M1 (1 ) 

201 10*  COMMON/FILES/KSAVE, KDATA , KPLOT, KLIST , KTERM 

20120*  COMMON/ND IMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

20130*  COMMON/NDIMT/NNT , NRT , NMT , NWT 

20140*  COMMON/LOCT/LPHT, LBDT, LQDT, LHT, LRT, LTDT, LTNT 

20150*  C0MM0N/TRUMTX/NVTM,TM(1) 

20160*  DIMENSION  PCA( 1 ),PC( 1 ),ZMl ( 1 ),ZM2( 1 ) 

20170*  NDIMxNA 

20180*  NDIMlsNDIM+1 

20190*  CALL  TFRMTX (TM( LTDT ) , ZM 1 , NND , NNT , 2 ) 

20200*  IF(NDD.LT.I)  GO  TO  5 

20210*  IA*LADDR(NA,NND+1 , 1 ) 

20220*  CALL  TFRMTX (TM( LTNT ),ZM1(IA), NDD , NNT , 2 ) 

20230*  5  CALL  MSCALE(ZM1, ZMl, NPLD, NNT,-1 .) 

20240*  IA*LADDR(NA,1,NNT+1) 

20250*  CALL  IDNT(NPLD,ZM1(IA), 1.) 

20260*  CALL  MAT3(NPLD,NA,ZM1,PCA,ZM2) 

20270*  WRITE(KLIST, 101 )  TIME 

20280*  101  FORMAT ("O’ TRUE*  DESIGN  ERROR  COVARIANCE  AT  TIME  =  ",F6.4) 
20290*  CALL  MATIO ( ZM2 , NPLD , NPLD , 3 ) 

20300*  IAsI 

20310*  DO  10  1*1, NPLD 

20320*  NS*I+I 

20330*  ZMl (NS-1 )*SQRT(ZM2(IA) ) 

20340*  ZMl (NS)aPC(I) 

20350*  10  IA*IA4-NDIM1 


20360s  ZM1 (NVOUT)sTIME 

20370s  CALL  WPLOTF ( ZM1 , NVOUT ) 

20380s  RETURN 

20390sC  END  SUBROUTINE  DACOV 
20400s  END 

20410s  SUBROUTINE  AC0VUD(PC,QD,RKRKT,PHIT,PHI,RIMKH,ZM1,ZM2) 

20420s  C0MM0N/MAIN1 /NDIM, NDIM1 ,C0M1 ( 1 ) 

20430s  COMMON/ND IMD/NND , NRD , NPD , NMD , NDD , NUD , NWDD , NPLD, NWPNWD, NNPR 

20440s  COMMON/ND IMT/NNT , NRT , NMT , NVT 

20450s  COMMON/LOCT/LPHT , LBDT, LQDT, LHT, LRT, LTDT, LTNT 

20460s  COMMON/TRUMTX/NVTM, TM( 1 ) 

20470s  COMMON/LKF/LEADSN, LFLTRK, LFCOV 

20480s  COMMON/CKF/NVFLT, FLT ( 1 ) 

20490s  DIMENSION  PC( 1 ),QD( 1 ),RKRKT( 1 ),PHIT( 1 ),PHI( 1 ),RIMKH( 1 ), 

20500s  1  ZM1 ( 1 ) ,ZM2( 1 ) 

20510s  LlsLADDR(NDIMf 1 ,NNT+1 ) 

20520s  CALL  ZPART(ZM2(L1),NNT, NPLD, NDIM) 

20530s  CALL  TFRMTX ( PHIT , ZM2 , NNT , NNT , 2 ) 

20540s  L1sLADDR(NDIMf  NNT-fl  ,NNT4-1 ) 

20550s  CALL  TFRMTX(PHI,ZM2(L1 ), NPLD, NPLD, 2) 

20560s  L2sLADDR(NDIM, NNT+1 , 1 ) 

20570s  CALL  ZPART(ZM2(L2), NPLD, NNT, NDIM) 

20580s  CALL  MAT3 (NDIM, NDIM, ZM2, PC, ZM1) 

20590s  CALL  FPADD(ZM1,NDIM,QD,NNT,NNT,1,PC) 

20600s  CALL  IDNT(NNT,ZM2, 1 .) 

20610s  CALL  FMMUL(FLT(LFLTRK),TM(LHT),NPLD,NMD,NNT,ZM1) 

20620s  CALL  TFRMTX(ZM1 ,ZM2(L2),NPLD,NNT,2) 

20630s  CALL  TFRMTX ( R IMKH, ZM2 (L 1 ), NPLD, NPLD, 2) 

20640s  CALL  MAT3 (NDIM, NDIM, ZM2, PC, ZM1) 

20650=  CALL  FPADD(ZM1, NDIM, RKRKT, NPLD, NPLD, LI, PC) 

20660s  RETURN 

20670sC  END  SUBROUTINE  ACOVUD 

20680s  END 

20690s  SUBROUTINE  FPADD ( X , NX , T, NR Y , NCY , LADDR , Z ) 

20700s  DIMENSION  X(1 ),Z( 1 ),Y(NRY,NCT) 

20710s  CALL  FTMTX(X,Z, NX, NX) 

20720s  LAMlsLADDR-1 

20730=  DO  10  Is1,NCY 

20740=  LA1sLAMUNX»(I-1) 

20750=  DO  10  J=1,NRY 

20760s  LAIsLAUI 

20770=  10  Z(LA1)sZ(LA1)+Y(J,I) 

20780s  RETURN 

20790sC  END  SUBROUTINE  FPADD 
20800=  END 

20810s  SUBROUTINE  RSYS(A,L,ND,ITYPE,IVRT) 

20820=  COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL , LABORT 

20830=  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

20840=  COMMON/SYSMTX/NVSM, SM( 1 ) 

20850=  COMMON/AMC/AM( 1 ) 

20860s  COMMON/BDG/BD ( 1 ) 

20870=  DIMENSION  A( 1 ),L( 1 ),ND( 1 ),NAD( 14,2),IND(7,3),NTYP(2,3),NTITLE(3), 

20880s  1  NMAT ( 1 4 , 3 ) 

20890s  DATA  NTYP/7, 14,3,4,4,8/ 

20900=  DATA  N0/1HN/ 


20910s 

20920s 

20930s 
20940: 
20950s 
20960s 
20970s 
20980s 
20990s 
21000s 
21010s  110 

21020s  5 

21030s  101 

21040s 

21050s 

21060s 

21070s 

21080s 

21090s  10 

21100s  102 

21110s 

21120s 

21130s 

21140s 

21150s 

21160s  112 

21170s  12 

21180s 

21190s  15 

21200s 
21210s  16 
21220s 

21230s  17 
21240s 

21250s  18 
21260s  20 
21270s 

21280s  114 
21290s 
21300s  201 
21310s  21 
21320s 
21330s  22 

21340s 
21350s  23 
21360s  25 
21370s 
21380s  103 
21390s 
21400s  26 
21410s 
21420s  30 
21430s 
21440s 
21450s 


DATA  IND/1HN,1HR,1HP, 1HM, 1HD, 1HW,2HWD,2HNM,2HRM,2HPM,4( 1H  ), 

1  2HNT,2HRT,2HMT,2HWT, 1H  ,1H  ,1H  / 

DATA  NTXTLE/6HDESIGN, 7HCOMMAND, 5HTRUTH/ 

DATA  NMAT/1HA, 1HB,2HEX, 1HG, 1HQ, 1HC,2HDY,2HEY, 1HH,2HHN, 1HR.2HAN, 

1  2HGN, 2HQN, 2 HAM, 2HBM, 2HCM, 2HDM, 10 ( 1 H  ) , 2HAT , 2HBT , 2HGT , 2HQT , 2HHT , 

2  2HRT, 3HTDT, 3HTNT, 6 ( 1 H  )/ 

NDMsNTYPO,  ITYPE) 

NAR  s  NTYP ( 2 , IT YPE ) 

NTs NTITLE( ITYPE) 

WRITE(KLIST, 110)  NT 

P0RMAT(////1 IX, 5("*  "),A7,"  MODEL", 5("  •")////) 

WRITE  101, NT 

FORMAT ("OREAD  ",A7,"  MODEL  FROM  ‘DATA*  FILE  (Y  OR  N)  >") 

READ  111, IANS 
IF(IANS.EQ.NO)  GO  TO  10 
IFsl 

CALL  READPS(A, ND, ITYPE, IERR) 

IF(IERR.EQ.O)  GO  TO  201 
WRITE  102, NT 

FORMAT ("  ENTER  ",A7,"  MODEL  FROM  TERMINAL  (Y  OR  N)  >") 

READ  111, IANS 
IF(IANS.EQ.NO)  GO  TO  15 
IFs2 

DO  12  Isl ,NDM 

WRITE  112, IND(I, ITYPE) 

FORMAT ("  ENTER  ",A2,"  >") 

READ*,ND(I) 

GO  TO  201 
IF =3 

IF(ITYPE-2)  16,17,18 
CALL  DSND(ND) 

GO  TO  20 
CALL  CMDD(ND) 

GO  TO  20 
CALL  TRTHD(ND) 

IF(NDO).GT.O)  GO  TO  201 
WRITE  114, NT 

F0RMAT("0",A7»"  MODEL  SUBROUTINE  NON-EXISTENT") 

GO  TO  5 

IF(ITYPE-2)  21,22,23 
CALL  DSNDM(ND,NAD) 

GO  TO  25 

CALL  CMDDM(ND,NAD) 

GO  TO  25 

CALL  TRTHDM(ND,NAD) 

IF (L ABORT. EQ.O)  GO  TO  26 
WRITE  103>NT,LAB0RT 

FORMAT("OINSUFFICIENT  MEMORY  FOR  ",A7,"  MODEL,  NEED:  ",I4) 

RETURN 

L( 1 )s1 

DO  30  Is2,NAR 

L(I)sL(I-1 )+NAD(I-1 , 1 )*NAD(I-1 ,2) 

NPNTSsL ( NAR ) +NAD ( NAR , 1 )«NAD(NAR,2)-1 
IF(NPNTS.LE.NVSM)  GO  TO  34 
WRITE  104,NPNTS 


C-40 


■  .  *  . 
c*  4 


v’ 


21460*  104  FORMATdOINSUFFICIENT  MEMORY  /SYSMTX/,  NEED:  ",I4) 

21470*  LABORTsNPNTS 

21480*  RETURN 

21490*  34  IF(IF-2)  75,35,50 

21500*  35  IZ*1 

21510*  DO  40  1*1, NAR 

21520*  N1*NAD(I, 1 ) 

21530*  N2*NAD(I,2) 

21540*  IF( (N1 .EQ.O) .OR. (N2.EQ.0) )  GO  TO  40 

21550*  WRITE  113,NMAT(I,ITYPE) 

21560*  113  FORMAT< "CENTER  ",A3> 

21570*  CALL  ZMATIN(A(L(I)),N1,N2,IZ) 

21580*  40  CONTINUE 

21590*  GO  TO  75 

21600*  50  CALL  ZPART(A, 1 , NPNTS, 1 ) 

21610*  IF(ITYPE-2)  55,60,65 

21620*  55  CALL  DSNM(A(L(1)),A(L(2)),A(L(3)),A(L(4)),A(L(5)),A(L(6)),A(L(7)), 
21630*  1  A(L(8)),A(L(9)),A(L(10)),A(L(11)),A(L(12)),A(L(13)),A(L(14))) 

21640*  GO  TO  75 

21650*  60  CALL  CMDM(A(L(1)),A(L(2)),A(L(3)),A(L(4))) 

21660*  GO  TO  75 

21670*  65  CALL  TRTHM(A(L(1)),A(L(2)),A(L(3)),A(L(4)),A(L(5)),A(L(6)), 

21680*  1  A(L(7)),A(L(8))) 

21690*  75  IZ*0 

21700*  77  WRITE  105 

21710*  105  FORMAT ("OMODIFY  MATRIX  ELEMENTS  (Y  OR  N)  >") 

21720*  READ  111, IANS 

21730*  IF(IANS.EQ.NO)  GO  TO  88 

21740*  WRITE  106,(NMAT(I,ITYPE),I*1,NAR) 

21750*  106  F0RMAT(1X,14(2X,A3)) 

21760*  78  WRITE  107 

21770*  107  FORMAT ("  ENTER  MATRIX  NAME  >") 

21780*  READ  111, IANS 

21790*  DO  80  1*1, NAR 

21800*  IF(IANS.EQ.NKAT(I,ITYPE))  GO  TO  81 

21810*  80  CONTINUE 

21820*  GO  TO  78 

21830*  81  WRITE  116 

21840*  116  FORMAT ("  LIST  MATRIX  TO  TERMINAL  (T  OR  N)  >") 

21850*  READ  111, IANS 

21860*  IF(IANS.EQ.NO)  GO  TO  83 

21870*  CALL  MATLST(A(L(I)),NAD(I,1),NAD(I,2),NMAT(I,ITYPE),KTERM) 

21880*  83  CALL  ZMATIN(A(L(I)),NAD(I,1),NAD(I,2),IZ) 

21890*  GO  TO  77 

21900*  88  IF ( IT YPE • EQ . 2 ) C ALL  FTMTX(A(L( 1 ) ), AM,ND( 1 ),ND( 1 ) ) 

21910*  IF(ITYPE.EQ.1)CALL  FTMTX(A(L(2)),BD,ND(1 ),ND(2)) 

21920*  IF(IWRT)  95,92,93 

21930*  92  IWRT*1 

21940*  93  WRITE  115, NT 

21950*  115  FORMATCOWRITE  ",A7,"  MODEL  TO  ’SAVE’  FILE  (Y  OR  N)  >") 

21960*  READ  111, IANS 

21970*  IF(IANS.EQ.NO)  GO  TO  95 

21980*  CALL  WFILED ( IT YPE , NPNTS » ND , A ) 

21990*  IWRTs-1 

22000*  WRITE  109, NT 


22010s  109  FORMAT (6X, A 7»*  MODEL  WRITTEN  TO  'SAVE*  FILE") 

22020s  95  DO  100  Is1,NAR 
22030s  N1sNAD(I,l) 

22040s  N2=NAD(I,2) 

22050s  IF( (N1 .EQ.O) .OR. (N2.EQ.0) )  GO  TO  100 

22060s  CALL  MATLST(A(L(I) )  ,N1 , N2,NMAT(I,ITYPE) ,KLIST) 

22070s  100  CONTINUE 
22080s  111  FORMAT (A3) 

22090s  RETURN 

22100sC  END  SUBROUTINE  RSYS 
22110s  END 

22120s  SUBROUTINE  DSND(ND) 

22130s  DIMENSION  ND(1) 

22140s  ND( 1 )=0 

22150s  RETURN 

22l60sC  END  SUBROUTINE  DSND 

22170s  END 

22180s  SUBROUTINE  CMDD(ND) 

22190s  DIMENSION  ND(1) 

22200s  ND( 1 )sO 

22210s  RETURN 

22220sC  END  SUBROUTINE  CMDD 

22230s  END 

22240s  SUBROUTINE  TRTHD(ND) 

22250s  DIMENSION  ND(l) 

22260s  ND( 1 )sO 

22270s  RETURN 

22280sC  END  SUBROUTINE  TRTHD 

222 90s  END 

22300s  SUBROUTINE  DSNM(A,B,EX,G,Q,C,DY,EY,H,HD,R,AD,GD,QD) 

22310s  RETURN 

22320sC  END  SUBROUTINE  DSNM 

22330s  END 

22340s  SUBROUTINE  CMDM( AM, BM, CM,  DM) 

22350s  RETURN 

22360sC  END  SUBROUTINE  CMDM 

22370s  END 

22380s  SUBROUTINE  TRTHM(AT,BT,GT,QT,HT,RT, TDT,TNT) 

22390s  RETURN 

22400sC  END  SUBROUTINE  TRTHM 

22410s  END 

22420s  SUBROUTINE  DSNDM(ND,NAD) 

22430s  COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT, LFLKF , LTEVAL, LABORT 

22440s  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD , NWPNWD , NNPR 
22450s  COMMON/DSNMTX/NVDM, NODY,NOEY,DM( 1 ) 

22460s  DIMENSION  ND(1 ),NAD( 14,2) 

22470s  NNDsND(l) 

22480s  NRDsND(2) 

22490s  NPDsND(3) 

22500s  NMDsND(4) 

22510s  NDDsND(5) 

22520s  NWDsND(6) 

22530s  NWDDsND(7) 

22540s  NPLDsNND-fNDD 

22550s  NWPNWD*NWD+NWDD 


22560s  NNPRzNND+NRD 

22570s  NAD( 1,1 )sNND 

22580s  NAD(2,1)=NND 

22590s  NAD(3» 1 )*NND 

22600s  NAD(4,1)=NND 

22610s  NAD(5» 1 )sNHD 

22620s  NAD(6,1)sNPD 

22630s  NAD(7» 1)=NPD 

22640s  NAD(8, l)sNPD 

22650s  NA0(9» 1 )sNMD 

22660s  NAD(10,1)sNMD 

22670s  NAD(11,1)sNMD 

22680s  NAD(12,1)=NDD 

22690s  NAD(13,1)=NDD 

22700s  NAD(l4,1)sNWDD 

22710s  NAD( 1 ,2)=NND 

22720s  NAD(2,2)sNRD 

22730s  NAD(3,2)=NDD 

22740s  NAD(4,2)=NWD 

22750s  NAD(5,2)=NWD 

22760s  NAD(6,2)=NND 

22770s  NAD(7,2)=NRD 

22780s  NAD(8f 2)=NDD 

22790s  NAD(9,2)sNND 

22800s  NAD( 10,2)=NDD 

22810s  NAD( 1 1 ,2)=NMD 

22820s  NAD( 12, 2)sNDD 

22830s  NAD(13,2)sHWD0 

22840s  NAD(14,2)=NMDD 

22850=  NSIZEsNPLD* (2*NPLD+NND+NMD+NPD+NWPNWD ) +NRD* ( NND+NPD ) + 

22860s  1  NDD*NDD+NMD*NMD+NHD*NWD+NWDD*NWDD 

22870=  IF(NSIZE.GT.N7DM)  LABORTsNSIZE 

22880=  RETURN 

22890sC  END  SUBROUTINE  DSNDN 
22900s  END 

22910=  SUBROUTINE  CMDDH(ND,NAD) 

22920s  COMMON/ND IMC/NNC  ,  NRC ,  NPC 

22930=  COMMON/CMDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

22940=  COMMON/DESIGN/NVCOM , TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL , LABORT 

22950=  DIMENSION  ND< 1 ),NAD( 14,2) 

22960=  NNCsND( 1 ) 

22970s  NRCsND(2) 

22980=  NPC=ND(3) 

22990=  NAD<1,1)=NNC 

23000=  NAD(2,1)sNNC 

23010s  NAD(3» 1 )sNPC 

23020=  NAD(4,1}sNPC 

23030=  NAD( 1 ,2)=NNC 

23040s  NAD(2,2)sNRC 

23050=  NAD(3>2)sNNC 

23060=  NAD(4,2)=NRC 

23070=  NSIZEsNNC* (NNC+NRC+NPC)+NPC»NRC 

23080=  IF ( NSIZE •  GT  • NVCM)  LABORTsNSIZE 

23090=  RETURN 

23100=C  END  SUBROUTINE  CMDDM 


23110*  END 

23120*  SUBROUTINE  TRTHDM(ND, NAD) 

23 1 30*  COMMON/D ESIGN/NVCOM, TSAMP, LFLRPI , LFLCGT, LFLKF, LTEVAL, LABORT 

23140*  COMMON/ND IMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

23150*  COMMON/ND IMT/NNT, NRT, NMT, NWT 

23160*  COMMON/TRUMTX/NVTM,TM( 1 ) 

23170*  DIMENSION  ND(  1  ),NAD(  1-4,2) 

23180*  NNTsND(l) 

23190*  NRT*ND(2) 

23200*  NMT*ND(3) 

23210*  NVT*ND(4) 

23220*  NAD(1,1)*NNT 

23230*  NAD(2,1)*NNT 

23240*  NAD(3» 1 )*NNT 

23250*  NAD(4,1)*NWT 

23260*  NAD(5,1)*NMT 

23270*  NAD(6,1)*NMT 

23280*  NAD(7» 1)*NND 

23290*  NAD(8,1)*NDD 

23300*  NAD(1,2)*NNT 

23310*  NAD(2t2)*NRT 

23320*  NAD(3»2)*NWT 

23330*  NAD(4t2)*NVT 

23340*  NAD(5,2)*NNT 

23350*  NAD(6,2)*NMT 

23360*  NAD(7t 2)*NNT 

23370*  NAD(8f2)*NNT 

23380*  NSIZE*NNT» (2»NNT+NMD*NRD^NPLD)+NMD»NMD 

23390*  IF(NSIZE.GT.NVTM)  LABORTsNSIZE 

23400*  RETURN 

23410*0  END  SUBROUTINE  TRTHDM 

23420*  END 

23430*  SUBROUTINE  ZMATIN(ArNR,NC,IZ) 

23440*  DIMENSION  A(NR,NC) 

23450*  IF(IZ)  10,10,1 

23460*  1  DO  5  1*1, NR 

23470*  DO  5  J*1,NC 

23480.  5  A(I,J)*0. 

23490*  10  WRITE  101,NR,NC 

23500*  15  READ*, I, J, 7 

23510*  IF(I.EQ.O)  RETURN 

23520*  IF( (I.LE.NR) .AND. ( J.LE.NC) )  GO  TO  20 

23530*  WRITE  102 

23540*  GO  TO  10 

23550*  20  A(I,J)»V 

23560*  IF(IZ.LT.O)  A( J,I)*V 

23570*  GO  TO  15 

23580*  101  FORMATC  ENTER  I,J  AND  M(I,J)— (0/  WHEN  COMPLETE)  :  "12,"  BY 
23590*  1  "  >") 

23600*  102  FORMAT ("  ERROR  IN  ARRAY  INDEX") 

23610*C  END  SUBROUTINE  ZMATIN 
23620*  END 

23630*  SUBROUTINE  WFILED(NT, NP,ND,A) 

23640*  COMMON/F ILES/KSAVE , KDATA , KPLOT , KLIST , KTERM 

23650*  DIMENSION  ND(15),A(NP) 


23660s  DATA  IE0I/-1/ 

23670s  BACKSPACE  KSAVE 

23680s  WRITE (KSAVE, 101 )  NT,NP 

23690s  WRITE( KSAVE, 101)  (ND(I), Isl , 15) 

23700s  WRITE( KSAVE, 102)  (A(I),I=1,NP) 

23710s  WRITE (KSAVE, 101)  IE0I,NP 

23720s  RETURN 

23730s  101  F0RMAT(2I4) 

237110s  102  FORMAT  (E20. 10) 

23750sC  END  SUBROUTINE  WFILED 
23760s  END 

23770s  SUBROUTINE  READFS(A, ND, NT, IERR) 

23780s  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

23790s  DIMENSION  A(1),ND(15) 

23800s  DATA  IE0I/-1/ 

23810s  REWIND  KDATA 

23820s  5  READ (KDATA, 102)  IT,NP 

23830s  IF(IT.NE.IEOI)  GO  TO  10 

23840s  WRITE  101 

23850s  IERRsI 

23860=  RETURN 

23870s  10  CALL  FARRAY(A,ND,NP) 

23880=  IF(IT.NE.NT)  GO  TO  5 

23890s  IERRsO 

23900=  101  FORMAT ( "ODATA  NOT  IN  'DATA*  FILE  .  .  .") 
23910=  102  F0RMAT(2I4) 

23920s  RETURN 

23930=C  END  SUBROUTINE  READFS 

23940s  END 

23950=  SUBROUTINE  FARRAY(A,ND,NP) 

23960s  COMMON/FILES/KSAVE, KDATA , KPLOT, KLIST, KTERM 

23970=  DIMENSION  A(NP),ND(15) 

23980s  READ(KDATA, 101 )  (ND(I), Isl , 15) 

23990=  READ(KDATA, 102)  (A(I),I=1,NP) 

24000=  RETURN 
24010=  101  FORMAT (214) 

24020s  102  P0RMAT(E20. 10) 

24030sC  END  SUBROUTINE  F ARRAY 
24040s  END 

24050s  SUBROUTINE  TFRMTX(X1 ,X2,NR,NC,ITX) 

24060s  C0MM0N/MAIN1/NDIM 

24070=  DIMENSION  X1(1),X2(1) 

24080=  IF(ITX.EQ.2)  GO  TO  20 

24090s  JsNC*NDIM 
24100=  KK=0 
24110s  DO  10  Is1,J,NDIM 

24120s  L*I+NR-1 

24130s  DO  10  JJsI,L 

24140s  KKsKKi-1 

24150s  10  XI (KK)sX2(JJ) 

241 60s  RETURN 

24170s  20  KK*NR*NC+1 
24180s  DO  30  Isl ,NC 
24190s  Ls(NC-I)fNDIM+1 

24200s  DO  30  Js1,NR 
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24210s  KKsKK-1 
24220s  JJsL+NR-J 
24230s  30  X2(JJ)sX1(KK) 

24240s  RETURN 
24250s  END 

24260s  SUBROUTINE  MATLST ( A , NR , NC , NT , KDEV ) 

24270s  DIMENSION  A(NR,NC) 

24280s  WRITE(KDEV, 101 )  NT 

24290s  DO  10  Isl.NR 

24300s  10  WRITE(KDEV, 102)  (A(I, J) , Jsl ,NC) 

24310s  101  FORMAT (1 HO, A3,"  MATRIX"/) 

24320s  102  F0RMAT(1X1P10G13.4) 

24330s  RETURN 

24340sC  END  SUBROUTINE  MATLST 

24350s  END  \ 

24360s  SUBROUTINE  NDSCRT ( A ,  N,  NTERMS)-' 

24370s  COMMON/DESIGN/NVCOM, TSAMP, LFLRPI , LFLCGT, LFLKF, LTEVAL, LABORT 

24380s  DIMENSION  A(1) 

24390s  NTERMSsIFIX(6«+3«*TSAMP*XNORM(N,A) ) 

24400s  IF(NTERMS.GT.30)  NTERMS=30 

24410s  RETURN 

24420sC  END  SUBROUTINE  NDSCRT 

24430s  END 

24440s  SUBROUTINE  RQWGTS(W,ND,NP) 

24450s  DIMENSION  W( 1 ) 

24460s  10  WRITE  101 

24470s  101  FORMATC"  ENTER  I  AND  QW(I,I)— (0/  WHEN  COMPLETE)  >") 

24480s  15  READ«,I,V 

24490s  IF(I.EQ.O)  RETURN 

24500s  IF(I.LE.ND)  GO  TO  20 

24510s  WRITE  102 

24520s  102  FORMAT ("  ERROR  IN  ARRAY  INDEX") 

24530s  GO  TO  10 

24540s  20  IF(V)  25.30,40 

24550s  25  WRITE  103 

24560s  103  FORMAT (*  ELEMENTS  MUST  BE  NON-NEGATIVE") 

24570s  GO  TO  15 

24580s  30  IF(NP)  35,40,35 

24590s  35  WRITE  104 

24600s  104  FORMAT ("  ELEMENTS  MUST  BE  POSITIVE") 

24610s  GO  TO  15 

24620s  40  L1sLADDR(ND,I,I) 

24630s  W(L1)sV 

24640s  GO  TO  15 

24650sC  END  SUBROUTINE  RQWGTS 

24660s  END 

24670s  SUBROUTINE  DVCTOR(N,A,V) 

24680s  DIMENSION  A(1),V(1) 

24690s  NP1sN+1 

24700s  N2sN*N 

24710s  JsO 

24720s  DO  10  Is1,N2,NP1 

24730s  JsJ+1 

24740s  10  V( J)sA(I) 

24750s  RETURN 


24760*C  END  SUBROUTINE  DVCTOR 
24770*  END 

24780*  SUBROUTINE  P0LES(A,N,ITYPE,ZM1,ZM2) 

24790=  C0MM0N/MAIN1/NDIM, NDIMl ,C0M1 ( 1 ) 

24800*  COMMON/D  ESIGN /N VCOM , TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL, LABORT 

24810*  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

24820*  DIMENSION  NTYP(5),A(1),ZMl(1),ZM2(1) 

24830*  DATA  NTYP/6HDESIGN,7HCOMMAND,5HTRUTH,5HREGPI,6HFILTER/ 
24840*  NDS*NDIM 

24850*  NDIM*N 

24860*  NDIMl sNDIM+1 

24870*  CALL  EIGEN(NDIM, A,ZM1 ,ZMl (NDIM1 ),ZM2,0) 

24880=  IF(ITYPE.LT.4)  GO  TO  10 

24890=  CALL  MAP0LE(N,ZM1 ,ZM1 (NDIMl ), TSAMP) 

24900=  10  WRITE (KLIST, 102)  NTYP(ITYPE) 

24910=  WRITE(KTERM, 102)  NTYP(ITYPE) 

24920=  WRITE(KLIST,101)  (ZM1(I),ZM1(NDIM+I),I=1,N) 

24930=  WRITE(KTERM, 101 )  (ZMl (I),ZM1 (NDIM+I),I=1 ,N) 

24940*  NDIMsNDS 

24950=  NDIMl sNDIM+1 

24960=  101  F0RMAT(6X,1PE15.7,"  +J(", 1 PEI 5 . 7, " ) " ) 

24970=  102  FORMAT ("OPOLES  OF  ",A7,»  MATRIX"/) 

24980=  RETURN 

24990=C  END  SUBROUTINE  POLES 
25000=  END 

25010=  SUBROUTINE  MAPOLE(N,ZR,ZI,T) 

25020=  DIMENSION  ZR(1)#ZI(l) 

25030=  RT=1./T 

25040=  DO  10  1=1 ,N 

25050=  ZM=SQRT(ZR(I)**2+ZI(I)**2) 

25060=  SIGMA= RT*ALOG ( ZM) 

25070=  ZI(I)=RT*ATAN2(ZI(I),ZR(I)) 

25080=  10  ZR(I)=SIGMA 

25090=  RETURN 

25100=C  END  SUBROUTINE  MAPOLE 
25110=  END 

25120=  FUNCTION  LADDR(NR,I, J) 

25130*  LADDR=I+NR*( J-1 ) 

25140*  RETURN 

25150=C  END  FUNCTION  LADDR 

25160*  END 

25170*  SUBROUTINE  FTMTX(X, Y,NR,NC) 

25180*  DIMENSION  X(1),Y(1) 

25190=  NE*NR*NC 

25200=  DO  10  1*1, NE 

25210=  10  Y(I)*X(I) 

25220=  RETURN 

25230*C  END  SUBROUTINE  FTMTX 

25240*  END 

25250=  SUBROUTINE  FMMUL(X, Y,NR1 ,NC1 ,NC2,Z) 

25260=  DIMENSION  X(NR1 ,NC1 ), Y(NC1 ,NC2),Z(NR1 ,NC2) 

25270*  DOUBLE  PRECISION  TD 

25280*  DO  10  1*1, NR1 

25290*  DO  10  J* 1 , NC2 


25300s  TDsO.DOO 

25310s  DO  5  Ksl,NCl 

25320s  5  TDsTD+X(I,K)»Y(K,J) 

25330s  10  Z(I, J)=TD 

25340s  RETURN 

25350sC  END  SUBROUTINE  FMMUL 

25360s  END 

25370s  SUBROUTINE  FTMUL(X,Y,NR1 ,NC1 ,NC2,Z) 

25380s  DIMENSION  X(NR1,NC1),Y(NR1,NC2),Z(NC1,NC2) 

25390s  DOUBLE  PRECISION  TD 

25400s  DO  10  Is1,NC1 

25410s  DO  10  Js1,NC2 

25420s  TDsO.DOO 

25430s  DO  5  Ksi,NR1 

25440s  5  TDsTD+X(K,I)*Y(K,J) 

25450s  10  Z(I,J)sTD 

25460s  RETURN 

25470sC  END  SUBROUTINE  FTMUL 

25480s  END 

25490s  SUBROUTINE  FMADD(X, Y,NR,NC,Z) 

25500s  DIMENSION  X( 1 ) , Y( 1 ) , Z( 1 ) 

25510s  NE=NR*NC 

25520s  DO  10  1=1, NE 

25530s  10  Z(I)=X(I)+Y(I) 

25540s  RETURN 

25550sC  END  SUBROUTINE  FMADD 

25560s  END 

25570*  SUBROUTINE  ZPART(A,NR,NC,ND) 

25580s  DIMENSION  A(1) 

25590s  NE=NC*ND 

25600s  DO  10  Isl ,NR 

25610s  DO  10  J=I,NE,ND 

25620s  10  A(J)sO. 

25630s  RETURN 

25640sC  END  SUBROUTINE  ZPART 

25650s  END 

25660s  SUBROUTINE  SUBI(A, NR,ND) 

25670s  DIMENSION  A(1) 

25680s  ND1sND+1 

25690s  NEsNR*ND 

25700s  DO  10  I*1,NE,ND1 

25710s  10  A(I)sA(I)-l. 

25720s  RETURN 

25730sC  END  SUBROUTINE  SUB I 

25740s  END 

25750s  SUBROUTINE  WPLOTF(V,N) 

25760s  COMMON/FILES/KSA VE , KDATA , KPLOT , KLIST , KTERM 

25770s  DIMENSION  V(N) 

25780s  WRITE (KPLOT, 101 )  (V(I),Is1,N) 

25790s  RETURN 

25800s  101  FORMAT (E20. 10) 

258l0sC  END  SUBROUTINE  WPLOTF 

25820s  END 

25830s  SUBROUTINE  RPLOTF(V,N,IERR) 

25840s  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST,KTERM 
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25850s  DIMENSION  V(N) 

25860s  READ(KPL0T,101)  (V(I),I=1,N) 

25870s  IF(EOF(KPLOT) )  5,10 

25880s  5  IERR=1 

25890s  RETURN 

25900s  10  IERRsO 

25910s  RETURN 

25920s  101  F0RMAT(E20.10) 

25930sC  END  SUBROUTINE  RPLOTF 
25940s  END 

25950s  SUBROUTINE  STRPLT(A,V,NS,NV,NP,NVO) 

25960s  DIMENSION  A(1 ),NS( 1 ),NV( 1 ), V(1 ) 

25970s  A(NS(l))sV(NVO) 

25980*  DO  5  1=1, NP 

25990=  5  A(NS(I+1 ) )sV(NV(I) ) 

26000=  RETURN 

26010sC  END  SUBROUTINE  STRPLT 

26020s  END 

26030s  SUBROUTINE  PLOTLP ( N , M , A , IPSC , ISCL , LPTERM, NDEV , ITITLE ) 

26040=0  •»**»••»»* 

26050=0  *  N  =  NUMBER  OF  POINTS  TO  BE  PLOTTED 

26060=0  •  M  =  NUMBER  OF  OUTPUTS  TO  BE  PLOTTED 

26070=0  *  A  =  VECTOR  OF  SAMPLE  POINTS  FOR  PLOTTING  :  DIMENSION  =  N*M 

26080=0  •  ELEMENTS  1  TO  N  ARE  THE  INDEPENDENT  VARIABLE 

26090=0  •  ELEMENTS  (N+1)  TO  2*N,  (2«N+1)  TO  3*N,  AND  SO  ON  ARE 

26100=0  •  THE  DEPENDENT  VARIABLES— EACH  VARIABLE  IS  IN  CONSECUTIVE 

26110=0  •  STORAGE  WITH  CORRESPONDING  SAMPLE  POINTS  FOR  EACH 

26120=0  •  SEPARATED  BY  MULTIPLES  OF  N 

26130=0  *  IPSC  s  -1  =>  SCALE  ALL  VARIABLES  TOGETHER  (1  PLOT) 

26140=0  •  =  0  =>  SCALE  TOGETHER  AND  SEPARATELY  (2  PLOTS) 

26150=0  •  =  +1  =>  SCALE  SEPARATELY  (1  PLOT) 

261 60=0  •  ISCL  a  0  *>  PLOT  OVER  EXACT  RANGE  OF  VARIABLE 

26170=0  •  =  1  =>  PLOT  USING  EVEN  SCALING 

261 80=0  •  LPTERM  =  0  =>  PLOT  IS  TO  TERMINAL  (50  CHARACTERS  WIDE) 

26190=0  *  =  1  =>  PLOT  IS  TO  LINE  PRINTER  (100  CHARACTERS  WIDE) 

26200=C  •  NDEV  =  DEVICE  NUMBER  FOR  PLOT  OUTPUT 

26210=C  •  ITITLE  =  VECTOR (DIMENSIONED  5)  WITH  50  CHARACTER  TITLE 

26220=C  ••*•••••■• 

26230=  DIMENSION  YSCAL(6),YMIN(6),IBLNK(6),YPR(11),A(1) 

26240=  INTEGER  OUT( 101), SYMBOL( 6 ) , BLANK, PLUS, GRID, ITITLE( 5 ) 

26250=  DATA  BLANK, PLUS, COLON, SYMBOL/ 1H  , 1H+, 1H:, 1H1 , 1H2, 1H3, 1H4, 1H5, 1H6/ 
26260=  1  F0RMATOH  ) 

26270=  2  FORMAT(1H1,11X,5A10/) 

26280=  10  FORMATOH  ,F11 ,2,6X,  101A1 ) 

26290=  12  FORMAT ( 1 1H0  SCALE  ,A1 , IX, 1 1F10.4) 

26300=  IPAPERs5*( 1+LPTERM) 

26310=  ISPAC=10*IPAPER 

26320=  RISPACsFLOAT ( ISPAC ) 

26330=  ISPACs  ISP AC+ 1 

26340=  IPRT1=IPAPER+1 

26350s  RMIN=A(N+1) 

26360s  RMAXsRMIN 

26370=  25  DO  41  ISC=1,M 

26380s  M1=ISC*N+1 

26390=  YLsA(Ml) 


C-49 


26400s 

26410s 

26420s 

26430s 

26440s 

26450s 

26460s  30 

26470s  40 

26480s 

26490s 

26500s 

26510s  41 

26520s 

26530s 

26540s 

26550s  45 

26560s 

26570s 
26580s 
26590= 
26600= 
26610= 
26620= 
26630=  458 
26640=  460 
26650=  461 
26660= 
26670=  46 
26680= 
26690= 
26700= 
26710=  47 
26720= 
26730=  48 
26740= 
26750=  49 
26760=  50 
26770=  55 
26780= 
26790= 
26800= 
26810=  59 
26820=  60 
26830= 
26840=  67 
26850=  68 
26860= 
26870=  70 
26880= 
26890= 
26900=  72 

26910s 
26920= 
26930s  74 
26940=  76 


YH=YL 

M2=N*(ISC+1 ) 

DO  40  J=Ml ,M2 
IFU(J).LT.YL)  GO  TO  30 
IFU(J).GT.YH)  YH=A( J) 

GO  TO  40 
YL=A( J) 

CONTINUE 

IF(YL.LT.RMIN)RMIN=YL 
IF(YH.GT.RMAX)  RMAXsYH 

IF(IPSC.GE.O)  CALL  VARSCL(YL,YH,YSCAL(ISC),RISPAC,ISCL) 
YMIN(ISC)=YL 

IF(IPSC.LE.O)CALL  VARSCL(RMIN,RMAX,SCAL,RISPAC,ISCL) 
IC=2-IABS(IPSC) 

DO  45  IX= 1 , ISPAC 
OUT(IX)=BLANK 
DO  100  ICOsl.IC 

WRITE(NDEV,2)  (ITITLE(I),I=1,5) 

DO  60  1=1, N 
XPR=A(I) 

IF(MOD(I, 10) .EQ.O)  GO  TO  458 

GRIDsBLANK 

GO  TO  460 

GRIDsCOLON 

DO  461  IX=2,ISPAC,2 

OUT(IX)=GRID 

DO  46  IX=1, ISPAC, 10 

OUT ( IX )= PLUS 

DO  55  J=1,M 

IL=I+J*N 

IF(IPSC)  48,47,49 
IPSCT=IPSC+ICO 
IF(IPSCT.EQ.2)  GO  TO  49 
JP=IFIX((A(IL)-RMIN)/SCAL)+1 
GO  TO  50 

JP=IFIX( (A(IL)-YMIN( J) ) /YSCAL( J) )+1 
OUT( JP)=SYMBOL( J) 

IBLNK( J)=JP 

WRITE (NDEV, 10)  XPR, (0UT(IX),IX=1 , ISPAC) 

DO  59  J=1 ,M 
ITEMPsIBLNK(J) 

OUT ( ITEMP ) sBLANK 
CONTINUE 

IF(IPSC)  68,67,72 

IF(IPSCT.EQ.2)  GO  TO  72 

YPR(1 )=RMIN 

DO  70  1=1 ,IPAPER 

YPR(I+1 )=YPR(I)+10.*SCAL 

WRITE (NDEV, 12)  BLANK, ( YPR(I) , 1=1 ,IPRT1 ) 

GO  TO  100 
DO  76  ISCsl ,M 
YPR( 1 )=YMIN(ISC) 

DO  74  I=1,IPAPER 

YPR(I+1 )sYPR(I)+10.»YSCAL(ISC) 

WRITE (NDEV, 12)  SYMBOL(ISC) , (YPR(IX) , IX=1 ,IPRT1 ) 


26950s  100  WRITE (NDEV, 1 ) 

26960s  RETURN 

26970sC  END  SUBROUTINE  PLOTLP 

26980s  END 

26990s  SUBROUTINE  VARSCL(XMIN,XMAX, SCALE, RSPACE,ISCL) 

27000s  IF(XMAX.EQ.XMIN)  XMIN=.9»XMIN-10. 

27010s  SCALEsXMAX-XMIN 

27020s  IF(ISCL.EQ.O)  GO  TO  25 

27030s  EXPsIFIXd  00  ,+ALOGIO  (SCALE) )-100. 

270H0s  FACTORS 10.**< 1. -EXP) 

27050s  XMINTsXMIN»FACTOR 

27060s  XMAXT = XMAX *F ACTOR 

27070s  IF(XMAXT.GE.O.)  XMAXT=XMAXT+.9 

27080s  IF(XMINT.LE.O.)  XMINTsXMINT—9 

27090s  XHINTsAINT(XMINT) 

27100s  ISCALsXMAXT-XMINT 

27110s  IF(MOD(ISCAL,5).NE.O)  ISCAL=ISCAL+5-M0D(ISCAL, 5) 

27120s  FACTORS 10.*»( EXP- 1.) 

27130s  XMIN=XMINT*F ACTOR 

27140s  SCALEsFACTOR*FLOAT( ISCAL) 

27150s  25  SCALEsSCALE/RSPACE 
27160s  RETURN 

27170sC  END  SUBROUTINE  VARSCL 
271 80s  END 

27190s  SUBROUTINE  PFDATA(ICODE,ND) 

27200s  C0MM0N/MAIN1 /NDIM, NDIMl ,C0M1 ( 1 ) 

27210s  C0MM0N/MAIN2/C0M2 ( 1 ) 

27220s  COMMON/I NOU/KIN,  KOUT , KPUNCH 

27230s  COMMON/DESIGN/NVCOM, TSAMP, LFLRPI, LFLCGT,LFLKF, LTEVAL, LABORT 

27240=  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

27250=  COMMON/SYSMTX/NVSM, SM( 1 ) 

27260=  C0HH0N/ZMTX1 /NVZM, ZM1 ( 1 ) 

27270=  C0MM0N/ZMTX2/ZM2 ( 1 ) 

27280=  COMMON/ND IMD/NND , NRD , NPD , NMD, NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

27290s  COMMON/LOCD/LAP, LGP, LPHI , LBD, LEX, LPHD.LQ, LQN, LQD, LC,LDY, LEY, LHP, LR 

27300=  COMMON/DSNMTX/NVDM, NODY, NOEY, DM( 1 ) 

27310s  COMMON/NDIMC/NNC, NRC, NPC 

27320s  COMKON/LOCC/LPHC,LBDC,LCC,LDC 

27330s  COMMON/CMDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

27340=  COMMON/ND IMT/NNT, NRT, NMT, NWT 

27350s  COMMON/LOCT/LPHT, LBDT, LQDT, LHT, LRT, LTDT, LTNT 

27360=  COMHON/TRUMTX/NVTM, TM( 1 ) 

27370=  COMMON/LCNTRL/LPI 1 1 , LPI1 2 , LPI2 1 , LPI22 , LPHDL , LBDL 

2 7380=  COMHON/CONTROL/NVCTL,CTL(1) 

27390s  COHMON/LREGPI/LXDW , LUDW , LPHCL , LGC 1 , LGC2 , LEL , LEE 

27400s  COMMON/CREGPI/NVRPI,RPI( 1 ) 

27410=  COMMON/LCGT/LA 1 1 , LA 1 3 , LA2 1 , LA23 , LA 1 2 , LA22 , LELA 1 1 , LELA 1 2 , LELA 1 3 

27420=  COMMON/CCGT/NVCGT , CGT ( 1 ) 

27430s  COMMON/LKF/LEADSN , LFLTRK , LFCOV 

27440=  COMHON/CKF/NVFLT , FLT ( 1 ) 

27450=  DIMENSION  ND(1) 

27460=  ND(l)sNND 

27470s  ND(2)=NRD 

27480=  ND(3)*NPD 


27500= 
27510= 
27520= 
27530= 
27540= 
27550= 
27560* 
27570= 
27580= 
27590= 
27600= 
27610* 
27620* 
27630* 
27640= 
27650= 
27660* 
27670= 
27680= 
27690= 
27700= 
27710= 
27720= 
27730=  90 
27740= 
27750= 
27760=  95 
27770= 
27780* 
27790=  100 
27800= 
27810= 
27820= 
27830=  105 
27840= 
27850*  200 
27860= 
27870= 
27880= 
27890* 
27900= 
27910= 
27920* 
27930= 
27940= 
27950* 
27960* 
27970* 
27980* 
27990* 
28000* 
28010* 
28020* 
28030* 
28040* 


ND(5)*NDD 

ND(6)=NPLD 

ND(7)*NNC 

ND(8)=NRC 

ND(9)*NPC 

ND( 10)*NNT 

ND( 11)=NRT 

ND( 12)*NMT 

ND(13)*N0DY 

ND( 14)*N0EY 

NVZMSsNVZH 

CALL  FTMTX(DM(LPHI),SM,NND,NND) 

LL*NND«NND+1 

CALL  FTMTX(DM(LBD),SM(LL),NND,NRD) 

LL=NND*NRD+LL 

IP(NDD.EQ.O)  GO  TO  100 

CALL  FTMTX(DM(LEX ) , SM(LL) , NND, NDD) 
LL=NND*NDD+LL 

CALL  PTMTX(DM(LPHD),SM(LL),NDD,NDD) 

LL*NDD»NDD+LL 

IF(NODY.EQ.I)  GO  TO  90 

CALL  FTMTX (DM(LDY),SM(LL), NPD, NRD) 
LL=NPD*NRD+LL 
IP(HOEY.EQ.I)  GO  TO  95 

CALL  FTMTX (DM(LEY) , SM(LL) , NPD, NDD) 
LL=NPD*NDD+LL 

CALL  FTMTX (DM( LHP ),SH(LL), NMD, MPLD) 
LL=NMD*NPLD+LL 
GO  TO  200 
CONTINUE 

IF(NODY.EQ.l)  GO  TO  105 

CALL  FTMTX (DM(LDY) , SM( LL) , NPD, NRD) 
LL=NPD»NRD+LL 

CALL  FTMTX(DM(LHP),SM(LL),NMD, NND) 
LL=NMD»NND+LL 

CALL  FTMTX (DM(LC) ,SM(LL) , NPD, NND) 
LL*NPD*NND+LL 

CALL  FTMTX ( CM( LPHC ) , SM ( LL ) , NNC , NNC ) 
LL*NNC»NNC+LL 

CALL  FTMTX(CM(LBDC) ,SM(LL),NNC,NRC) 
LL=NNC*NRC+LL 

CALL  FTMTX (CM(LCC) , SM(LL) , NPC, NNC) 
LL*NPC«NNC+LL 

CALL  FTMTX (TM(LPHT),SM(LL), NNT , NNT ) 
LL=NNT*NNT+LL 

CALL  FTMTX (TM(LBDT) ,SM(LL) , NNT, NRT) 
LL=NNT»NRT+LL 

CALL  FTMTX(TM(LQDT),SM(LL),NNT,NNT) 
LL*NNT«NNT+LL 

CALL  FTMTX(TM(LHT) ,SM(LL) , NMT,NNT) 
LL*NMTfNNT+LL 

CALL  FTMTX(TM(LRT) ,SM(LL) , NMT, NMT) 
LL*NMT»NMT+LL 

CALL  FTMTX(RPI(LGC1 ),SM(LL),NRD,NND) 
LL*NRD»NND+LL 
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28050=  CALL  FTMTX(RPI(LGC2),SM(LL),NRD,NPD) 

28060=  LL=NRD*NPD+LL 

28070=  CALL  FTMTX(CGT(LELA1 1 ) ,SM(LL) ,NRC,NNC) 

28080=  LL=NRC*NNC+LL 

28090=  IF(NDD.EQ.O)  GO  TO  300 

28100=  CALL  FTMTX(CGT(LELA13),SM(LL),NRD,NDD) 

28110=  LL=NRD*NDD+LL 

28120=  CALL  FTMTX(FLT(LFLTRK),SM(LL) ,NPLD,NMD) 

28130=  LL=NPLD*NMD+LL 

28140=  CALL  FTMTX(TM(LTDT),SM(LL),NND,NNT) 

28150=  LL=NND*NNT+LL 

28160=  CALL  FTMTX(TM(LTNT),SM(LL),NDD,NNT) 

28170=  LL=NDD«NNT+LL 

28180=  GO  TO  310 

28190=  300  CONTINUE 

28200=  CALL  FTMTX(FLT(LFLTRK),SM(LL),NND,NMD) 

28210=  LL=NND»NMD+LL 

28220=  CALL  FTMTX(TM(LTDT),SM(LL),NND,NNT) 

28230=  LL=NND*NNT+LL 

28240=  310  SM(LL)=TSAMP 

28250=  ND(15)=LL 

28260=  CALL  WFILED(ICODE,LL,ND,SM) 

28270=  NVZM=NVZMS 

28280=  RETURN 

28290=C  END  SUBROUTINE  PFDATA 
28300=  END 

28310=  SUBROUTINE  IMPLEX(A) 

28320=  C0MM0N/MAIN1/NDIM, NDIM1 ,C0M1 (1 ) 

28330=  COMMON/DESIGN/NVCOM,TSAMP,LFLRPI,LFLCGT,LFLKF,LTEVAL,LABORT 

28340=  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 
28350=  COMMON/SYSMTX/NVSM, SM( 1 ) 

28360=  C0MM0N/ZMTX1 /NVZM, ZM1 ( 1 ) 

28370=  COMMON/ND IMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

28380=  COMMON/LOCD/LAP , LGP , LPHI , LBD , LEX , LPHD , LQ, LQN, LQD , LC , LDY , LEY , LHP , LR 

28390=  COMMON/DSNMTX/N VDM , NODY, NOEY, DM( 1 ) 

28400=  COMMON/ND IMC/NNC, NRC , NPC 

28410=  COMMON/AMC/AM( 1 ) 

28420=  C0MM0N/BDG/BDO) 

28430=  DIMENSION  A(1) 

28440=  DATA  N0/1HN/ 

28450=  215  HRITE(KLIST, 126) 

28460=  126  F0RMAT(5C*  »), "COMBINED  IMPLICIT/EXPLICIT  CONTROL", 5("  •")) 

28470=  LQIal 

28480=  LR I IxLQI+NPD* NPD 

28490=  LRRI=LRIl4>NRD*NRD 

28500=  NPDNRDaNPD+NRD 

28510=  120  CALL  ZPART ( A , NPDNRD , NPDNRD , NPDNRD ) 

28520*  WRITE  122, NPD 

28530=  122  FORMAT ("  ENTER  WEIGHTS  ON  IMPLICIT  OUTPUT  DERIVATIVES:  ",I2) 

28540=  CALL  RQWGTS(A,NPD,0) 

28550=  WRITE  124, NRD 

28560=  124  FORMAT ("  ENTER  WEIGHTS  ON  IMPLICIT  CONTROL  MAGNITUDES:  ",I2) 

28570=  CALL  RQWGTS(A(LRII) , NRD, 1 ) 

28580*  LI =1 

28590=  L2=LUNND«NND 


28600s  L3=L2+NPD»NND 

28610s  U=L3+NPD«NND 

28620s  L5sU+NPD«NND 

28630s  L6sL5+NND»NPD 

28640s  L7=L6+NPD*NND 

28650s  IF(NDD.EQ.O)  GO  TO  5 

28660s  NDIMsNPLO 

28670s  NDIM1=NDIM+1 

28680s  GO  TO  10 

28690s  5  NDIMsNND 
28700s  NDIM1=NDIM+1 

28710s  10  CALL  TFRHTX(SM(L1),DM(LAP),NND,NND,1) 

28720s  CALL  FMMUL(DM(LC),SM(L1 ),NPD,NND,NND,SM(L2)) 

28730s  CALL  FMMUL(AM,DM<LC),NPD,NPD,NND,SM(L3)) 

28740s  NDIMsNPD 

28750s  NDIMlsNDIM+1 

28760s  CALL  MADD1 (NPD,NND,SM(L2),SM(L3),SM(L4),-1 .) 

28770s  CALL  FTRNSP(NPD,NND,SM(L4),SM(L5)) 

28780s  CALL  FMMUL(A,SM(L4),NPD,NPD,NND,SM(L6)) 

28790s  CALL  FMMUL(SM(L5),SM(L6),NND,NPD,NND,SM(L1 )) 

28800s  CALL  FTRNSP(NND,NRD,BD,SM(L2)) 

28810s  CALL  FTRNSP(NPD,NND,DM(LC),SM(L3) ) 

28820s  CALL  FMMUL(SM(L2),SM(L3),NRD,NND, NPD,SM(L4)) 

28830s  CALL  FMMUL(SM(L4),SM(L6),NRD,NPD,NND,SM(L5)) 

28840s  CALL  FTMTX(SM(L5),SM(L2),NRD,NND) 

28850s  CALL  FMMUL(SM(L4),A,NRD,NPD,NPD,SM(L5)) 

28860s  CALL  FMMUL(SM(L5),DM(LC),NRD,NPD,NND,SM(L6)) 

28870s  CALL  FMMUL(SM(L6),BD,NRD>NND,NRD»SM(L7) ) 

28880s  CALL  MADDl(NRD,!ffiD,A(LRII),SM(L7).SM(L5),1.) 

28890s  CALL  FTMTX (SM( L5 ) , SM ( L 3 ) * NRD , NRD ) 

28900s  WRITE  400 

28910s  400  FORMAT ("OLIST  *QIH*  MATRIX  TO  TERMINAL  (Y  OR  N)  >") 
28920s  READ  4 10, IANS 

28930s  410  FORMAT (A3) 

28940s  IF  (IANS.EQ.NO)GO  TO  490 

28950s  CALL  MATLST(SM(L1  ),NND,NND,”QIH1,,KTERM) 

28960s  WRITE  420 

28970s  420  FORMAT ("OCHANGE  IMPLICIT  WEIGHTS  (Y  OR  N)  >") 

28980s  READ  4 10, IANS 

28990s  IF(IANS.EQ.NO)GO  TO  490 

29000s  GO  TO  120 

29010s  490  CALL  MATLST ( A , NPD , NPD , "QI" , KLIST) 

29020s  CALL  DVCTOR(NPD,A,A(LRRI)) 

29030s  CALL  MATLST ( A (LRRI), NPD, 1,*QI",KTERM) 

29040s  CALL  MATLST ( A ( LRI I ) , NRD , NRD , ”R I” , KLIST ) 

29050s  CALL  DVCTOR(NRD,A(LRII),A(LRRI)) 

29060s  CALL  MATLST(A(LRRI),NRD,1,«RIW,KTERM) 

29070s  CALL  MATLST ( SM( L 1 ),NND,NND,"QIH", KLIST) 

29080s  CALL  MATLST(SM(L2),NRD,NND, "SIH",KLIST) 

29090s  CALL  MATLST (SM( L 3 ) , NRD , NRD , ”RIH" , KLIST ) 

29100s  RETURN 

29110sC  END  SUBROUTINE  IMPLEX 

29120s  END 

29130s  SUBROUTINE  MODXU(X,U) 

29140s  C0MM0N/MAIN1/NDIM, NDIMl ,C0M1 ( 1 ) 


r^TT  *■:  r.  .v  IT.'  ,*i 

£ 

■ 

tji.  •f.  v: '-•■?-  7* 

7-7V-  J>  -VJ  V  -J  -»  •>  V  ■»  VV  ■'  V  .»  -•  V  .* 

29150* 

C0MM0N/MAIN2/C0M2 ( 1 ) 

fs> 

29160a 

COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

r  >■'# 

29170a 

C0HM0N/SYSMTX/NVSM, SM( 1 ) 

29180a 

COMMON/ND IMD/NND, NRD, NPD,NMD,NDD,NWD, NWDD, NPLD, NWPNWD, NNPR 

i 

29190a 

COMMON/ND IMC/NNC , NRC , NPC 

29200a 

DIMENSION  X(1 ),U( 1 ) 

K 

29210a 

Llal 

[:• 

29220a 

L2=L1+NND*NND 

y 

29230a 

L3=L2+NRD*NND 

K 

29240a 

L4=L3+NRD*NRD 

29250a 

L5=L4+NND*NND 

29260a 

L6*L5+NND*NND 

29270a 

NDIMaNNPR 

> 

29280a 

NDIM1aNDIM+1 

•4 

29290a 

CALL  TFRMTX(SM(L4),X,NND,NND,1) 

£ 

29300a 

CALL  FMADD(SM(L4),SM,NND,  NND,SM(L5) ) 

I 

29310a 

CALL  TFRMTX(SM(L5),X,NND,NND,2) 

* 

29320a 

DO  10  I=1,NRD 

«n 

fl 

29330= 

LA= NNPR* (1-1 ) 

s 

29340= 

LB=L2+I-1 

Q 

29350= 

LEaLB-f  NRD*  ( NND- 1 ) 

29360= 

DO  10  J=LB,LE,NRD 

1 

29370= 

LAaLA+1 

7 

‘j 

29380=  10 

COM2 (LA ) =C0M2 (LA ) +SM( J ) 

;i 

29390= 

CALL  FMADD(SM(L3),U,NRD,NRD,U) 

•i 

29400= 

CALL  MATLST (X,NNPR, NNPR , *XIE» , KLIST) 

< 

29410= 

RETURN 

i  ^ 

29420=C  END  SUBROUTINE  MODXU 

P 

29430= 

END 

29440= 

SUBROUTINE  FTRNSP(NR,NC,A,B) 

>■ 

29450= 

DIMENSION  A( 1 ) ,B( 1 ) 

> 

29460= 

DO  10  Ial,NR 

29470= 

DO  20  Ja1(NC 

29480= 

B(  (1-1  )*NC+J)aA(  ( J-1 )*NR+I) 

l 

29490=  20 

CONTINUE 

r> 

29500=  10 

CONTINUE 

S 

29510= 

RETURN 

29520=C  END 

SUBROUTINE  FTRNSP 

s 

29530a 

END 

N 

1 

• 

K 

*.' 

s* 

a 

29540= *EOR 

i 

*4 

% 

,1i 

-1 

% 

!  .**. 

;  -s' 

5 

! 
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C.2  Subroutine  Changes  for  CGT/PI  Formulation  2 

Subroutines  CGTXQ,  SREGPI,  SCGT,  and  CGTKX  were 
changed  to  produce  the  program  based  on  CGT/PI  formulation 
2.  These  subroutines  are  listed  on  the  following  pages. 
Changed  lines  are  marked. 


2960s  SUBROUTINE  CGTXQ 

2970s  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

2980s  C0MM0N/MAIN2/C0M2 ( 1 ) 

2990s  COMMON/INOU/KIN, KOUT, KPUNCH 

3000s  C01W0N/DESIGN/NVC0M, TSAMP, LFLRPI, LFLCGT, LFLKF , LTEVAL, LABORT 

3010s  COMMON/FILES/KSAVE , KDATA , KPLOT, KLIST , KTERM 

3020s  COMMON/SYSMTX/NVSM, SM( 1 ) 

3030s  C0M10N/ZMTX1/NVZM,ZM1(1 ) 

3040s  C0Mf0N/ZtrrX2/ZM2(  1 ) 

3050s  COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD,NPLD, NWPNWD, NNPR 
3060s  COtffON/LOCD/LAP , LGP , LPHI , LBD » LEX , LPHD , LQ , LQN , LQD , LC , LDY , LEY , LHP , LR 

3070s  COMMON/DSNMTX/NVDM, NOD  Y, NOEY, DM( 1 ) 

3080s  COMMON/ND IMC/NNC , NRC , NPC 

3090s  COIMON/LOCC/LPHC , LBDC ,  LCC , LDC 

3100s  COHMON/CHDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

3110s  COMMON/NDIMT/NNT, NRT, NHT, NWT 

3120s  COMMON/LOCT/LPHT, LBDT, LQDT,LHT, LRT,LTDT, LTNT 

3130s  COMMON/TRUMTX/NVTM, TM( 1 ) 

3140s  COMMON/LCNTRL/LPI 1 1 , LPI1 2 , LPI2 1 , LPI22 , LPHDL, LBDL 

3150s  COMMON/CONTROL/NVCTL , CTL ( 1 ) 

3 1 60s  COMMON/LREGPX/LXDW , LUDH , LPHCL , LGC 1 , LGC2 , LEL, LEE 

3170s  C0MM0N/CREGPI/NVRPI,RPI(1) 

3180s  COMMON/LCGT/LA 1 1 ,  LA 1 3  #  LA2 1 , LA23 , LA 1 2 , LA22 , LELA 1 1 , LELA 1 2 , LELA 1 3 

3190s  C0MM0N/CCGT/NVCGT,CGT(1) 

3200s  COMMON/LKF/LEADSN, LFLTRK, LFCOV 

3210=  COMMON/CKF/NVFLT, FLT( 1 ) 

3220=  COMMON/AMC/AM( 1 ) 

3230=  COMMON /BDG/BD( 1 ) 

3240=  DIMENSION  LD( 15),ND( 15) 

3250=  DATA  NPLTZM/606/ 

3260=  DATA  IE0I,N0/-1,1HN/ 

3270=  REMIND  KLIST 

3280=  WRITE(KLIST,115)  DATE(DUM) ,TIME(DUM) 

3290=  WRITE(KTERM, 1 15)  DATE(DUM) ,TIME(DUM) 

3300=  115  F0RMAT("1",27X,"»  •  •  CGTPIQ  •  *  »"/l4X, 

3310=  1  "PROGRAM  TO  DESIGN  A  COMMAND  GENERATOR  TRACKER" /8X, 

3320=  2  "USING  A  REGULATOR  WITH  PROPORTIONAL  PLUS  INTEGRAL  C0NTR0LV13X, 

3330=  3  "BASED  ON  THE  INTEGRAL  OF  THE  REGULATION  ERROR, "/l6X, 

3340=  4  "AND  A  KALMAN  FILTER  FOR  STATE  ESTIMATION. "/28X, 

3350=  5  •  •  CGTPIQ  •  »  »"//11X,"DATE  :  ",A10//,11X, 

3360s  6  "TIME  :  ",A10////) 

3370=  REWIND  KSAVE 

3380=  REWIND  KDATA 

3390s  WRITE (KSAVE, 112)  IEOI,NPLTZM 

3400s  DO  10  1=1,15 

3410s  10  ND(I)s0 

3420=  DO  12  1*1,15 

3430=  12  LD(I)*1 

3440=  LFLRPIxO 

3450=  LFLCGTsO 

3460=  LFLKF* 0 

3470=  LTEVALsO 

3480=  LABORTsO 

3490=  IPIsO 
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3500*  ICGTsO 

3510s  ITRUsO 

3520s  IPLTRsO 

3530s  IC0DEs4 

3540s  LFAVALsO 

3550s  LGCGTsO 

3560s  NVCOMsMINO (NDIM, NVZM) 

3570s  KOUTsKLIST 

3580s  KPUNCHsKPLOT 

3590s  IF(NVSM.GE.NPLTZM)  GO  TO  50 

3600s  WRITE  101,NPLTZM 

3610s  GO  TO  1000 

3620s  50  WRITE  102 

3630s  READ*,TSAMP 

3640s  IF(TSAMP.LE.O.)  GO  TO  50 

3650s  WRITE(KLIST,103)  TSAMP 

3660s  103  FORMAT ( "0SAMPLE  PERIOD  IS  "^5.3,"  SECONDS") 
3670s  CALL  SETUP(ND,LD,ICGT,ITRU,1) 

3680s  IF(LABORT)  1000,100,1000 

3690s  100  LABORTsO 
3700s  IMPLICsO 

3710s  WRITE  104 

3720s  104  FORMAT ("OCONTROLLER  DESIGN  (Y  OR  N)  >») 

3730s  READ  111, IANS 

3740s  IF(IANS.EQ.NO)  GO  TO  500 

3750s  LFLKFsO 

3760=  CALL  PIMTX(IPI) 

3770s  IF(LABORT)  1000,125,1000 

3780=  125  WRITE  105 

3790=  105  FORMAT ( "ODESIGN  REG/PI  (Y  OR  N)  >") 

3800=  READ  111, IANS 

3810=  IP(IANS.EQ.NO)  GO  TO  150 


s  CALL  SETUP(ND,LD,ICGT,ITRU,4) 

3830=  IF(ICGT.EQ.O)  GO  TO  125 


WRITE  400 

3850=  400  FORMAT ( "OINCORPORATE  IMPLICIT  MODEL  (Y  OR  N)  >") 

3860=  READ  111, IANS 

3870s  IF(IANS.EQ.NO)  GO  TO  490 

3880s  IMPLICs  1 

3890s  CALL  SETUP ( ND , LD , ICGT , ITRU , 4 ) 

3900s  IF(ICGT.NE.O)  GO  TO  460 

3910=  IMPLICsO 

3920=  GO  TO  480 

3930=  460  IF(NPD.EQ.NNC)  GO  TO  480 

3940s  WRITE  470 

3950s  470  FORMAT ("OCOMUND  MODEL  STATE  DIM  MUST  EQUAL  SYSTEM  OUTPUT  DIM") 

3960=  LABORTs-1 

3970=  480  IF(LABORT)  100,490,1000 

3980=  490  CALL  SREGPI(IMPLIC) 

3990=  IF(LABORT)  1000,200,1000 

4000=  150  WRITE  106 

4010=  106  F0RMAT( "ODESIGN  CGT  (Y  OR  N)  >") 

4020=  READ  111, IANS 

4030=  IF(IANS.EQ.NO)  GO  TO  100 

4040=  CALL  SETUP(ND,LD,ICGT, ITRU, 2) 
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4050=  IF(ICGT)  155,100,155 
4060=  155  IF(LABORT)  100,160,1000 
4070=  160  CALL  SCGT 
4080=  IF(LABORT)  100,170,1000 

4090=  170  IF(LFLCGT.LE.O)  GO  TO  125 
4100=  200  LABORTsO 
4110=  WRITE  107 

4120=  107  FORMAT ( "©CONTROLLER  EVALUATION  WRT  TRUTH  MODEL  (Y  OR  N)  >") 

4130=  READ  111, IANS 

4140=  IF(IANS.EQ.NO)  GO  TO  250 

4150=  CALL  SETUP(ND,LD,ICGT,ITRU,3) 

4160=  IF(LABORT)  200,260,1000 

4170=  250  LTEVALsO 

4180=  260  CALL  CEVAL 

4190=  IF(LFLCGT.EQ.I)  LGCGTs 1 

4200=  IF(LFAVAL.EQ.O.OR.LGCGT.EQ.O)  GO  TO  100 

4210=  270  WRITE  600 

4220=  600  FORMAT* "OWRITE  PERFORMANCE  EVALUATION  DATA  TO  ‘SAVE*  FILE  (Y  OR  N) 
4230=  ♦>") 

4240=  READ  111, IANS 

4250=  IF(IANS.EQ.NO)  GO  TO  100 

4260=  ICODEsICODE+1 

4270=  CALL  PFDATA(ICODE.ND) 

4280=  INUM=IC0DE-4 

4290=  WRITE  605,INUM 

4300=  605  FORMAT* "OPERFORMANCE  EVALUATION  DATA,  NO.  *12, ".WRITTEN  TO  ’SAVE 
4310=  FILE") 

4320=  GO  TO  100 

4330=  500  LABORTsO 
4340=  WRITE  108 

4350=  108  FORMAT* "OFILTER  DESIGN  (Y  OR  N)  >") 

4360=  READ  111, IANS 

4370=  IF(IANS.EQ.NO)  GO  TO  900 

4380=  CALL  FLTRK(IFLTR) 

4390=  IF(IFLTR.EQ.O)  GO  TO  900 
4400=  IF(LABORT)  1000,510,1000 
4410=  510  CALL  SETUP(ND,LD,ICGT,ITRU,3) 

4420=  IF(LABORT)  500,525,1000 

4430=  525  CALL  FEVAL 

4440=  530  IF(LABORT)  1000,540,1000 

4450=  540  LFAVALsI 

4460=  IF*LGCGT.EQ.1)  GO  TO  270 

4470=  GO  TO  500 

4480=  900  WRITE  109 

4490=  109  FORMAT* "OEND  DESIGN  RUNS  (Y  OR  N)  >") 

4500*  READ  111, IANS 
4510=  IF(IANS.EQ.NO)  GO  TO  100 
4520*  IF(LFLRPI.EQ.O)  GO  TO  1000 
4530=  NPNTS«NRD«*NNPR+NND) 

4540=  ND* 1 )*NPNTS 
4550=  ND*2)=LGC1 

4560=  ND*3)=LGC2 
4570=  ND*4)sLEL 

4580=  CALL  WFILED*4,NPNTS,ND,RPI(LGC1 ) ) 

4590*  WRITE  113 
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4600s  1000  CONTINUE 
4610s  WRITE ( KLIST ,110) 

4620s  REWIND  KSAVE 

4630s  REWIND  KDATA 

4640s  REWIND  KLIST 

4650s  WRITE  110 

4660s  101  FORMAT ( "0 INSUFF IC IENT  MEMORY  /SYSMTX/,  NEED:  ",I4) 

4670s  102  FORMATCOENTER  SAMPLE  PERIOD  FOR  DIGITAL  CONTROLLER  >») 
4680s  110  FORMAT ("OPROGR AM  EXECUTION  STOP") 

4690s  111  F0RMATU3) 

4700s  112  FORMAT (214) 

4710s  113  F0RMAT(6X, "REG/PI  GAINS  WRITTEN  TO  ’SAVE*  FILE") 

4720s  RETURN 

4730sC  END  SUBROUTINE  CGTXQ 

4740s  END 


8720s  SUBROUTINE  SREGPI(IMPLIC) 

8730s  C0MM0N/MAIN1 /NDIM, NDIMl , C0M1 ( 1 ) 

8740s  COMWN/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , LFLKF, LTEVAL, LABORT 

8750s  COMMON/FILES/KSAVE , KDATA , KPLOT, KLIST  ,  KTERM 

8760s  COMMON/SYSMTX/NVSM, SM( 1 ) 

8770s  C0MM0N/ZMTX1/NVZM,ZM1(1) 

8780s  C0MM0N/ZMTX2 /ZM2 ( 1 ) 

8790s  COMfON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 
8800s  COMMON/LCNTRL/LPI 1 1 , LPI 1 2 , LPI2 1 , LPI22 , LPHDL , LBDL 

8810s  COMfON/CONTROL/NV  CTL , CTL ( 1 ) 

8820s  COMMON/LREGPI/LXDW , LUDW , LPHCL, LGC 1 , LGC2 , LEL, LEE 

8830s  COMMON/CREGPI/N?RPI,RPI( 1 ) 

8840s  COMMON/LOCD/LAP , LGP , LPHI , LBD , LEX , LPHD , LQ , LQN, LQD , LC , LDY , LEY, LHP , LR 

8850s  COMMON/DSHMTX/NVDM. NODY. NOEY, DM( 1 ) 

8860=  COMfON/NDIMC/NNC , NRC , NPC 

8870s  CO*MON/LOCC/LPHC,LBDC,LCC,LDC 

8880s  COMMON/CMDMTX/NVCM, NEWCM, NODC , CM( 1 ) 

^90^  WRITE  (KLIST,  110) 

8900s  110  F0RMAT(////11X,5("*  "), "REG/PI  DESIGN", 5("  •")////) 

8910s  NSIZEsNRD* ( 5 "NRD+2 "NND ) +NNPR*NNPR 

8920s  IF(NSIZE.LE.NVRPI)  GO  TO  5 

8930s  WRITE  101 ,NSIZE 

8940s  101  FORMAT ( "0 INSUFF IC I ENT  MEMORY  /CREGPI/,  NEED:  ",I4) 

8950=  GO  TO  8 

8960s  5  NSIZEsNNPR*(3*NNPR+NRD) 

8970s  IF ( NSIZE . LE . NVSM)  GO  TO  10 

8980s  WRITE  102, NSIZE 

8990s  102  FORMAT("OINSUFFICIENT  MEMORY  /SYSMTX/,  NEED:  ",I4) 

9000s  8  LABORTs NSIZE 

9010s  RETURN 

9020s  10  LXsl 

9030s  LUsLX+NNPR*NNPR 

9040s  CALL  WXUS(SM(LX),SM(LU),C0M1 ,ZM1,ZM2,IMPLIC) 

9050s  LUISTsLU+NNPR*NRD 

9060s  LPHPsLUIST+NNPR*NNPR 

9070s  CALL  PXUP ( CTL (LPHDL ) , CTL (LBDL),SM(LX),SM(LU), COM 1 , ZM2 , 

9080s  1  SM(LUIST) ,SM(LPHP) ,SM(LX) , ZM1 ) 


•  ^  I  *  •  %  *  fc'*  •  *  '  k  • 
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9090s  CALL  DRIC ( NDIM, SM( LPHP ) , ZM2 , SM( LX ) , ZMl , RPI ( LPHCL) ) 

9100s  CALL  GCSTAR(SM(LPHP),CTL(LBDL),SM(LU),ZM1,SM(LUIST),SM(LX),ZM2) 

9110s  CALL  TFRMTX(RPI(LGC1),SM(LX),NRD,NND,1) 

9120s  L3sLADDR(NDIM, 1 , NND+1 )+LX-l 

9130s  CALL  TFRMTX(RPI(LGC2),SM(L3),NRD,NRD,1) 

9140s  LI sLADDR(NNPR, NND+1, NND+1) 

9150s  L2sLADDR(NNPR,1, NND+1) 

9160s  CALL  GMINV(NRD,NRD,ZM1(L1),ZM1(L2),MR,1) 

9170s  L1sUDDR(NNPR, NND+1, 1) 

9160s  CALL  MMUL(ZM1(L2),ZM1(L1),NRD,NRD,NND,ZM1) 

9190=  CALL  MHUL(SM(L3).ZM1,NRD.NRD,NND,ZM1(L1 ) ) 

9200s  CALL  TFRMTX(C0M1,ZM1(L1).NRD.NND,1) 1 

9210s  CALL  MADD1 (NRD,NND,SM(LX),ZM1 (LI ),ZM1,-1 .) 

9220s  CALL  TFRMTX ( R PI ( LEL) , ZM 1 , NRD , NND , 1 ) 

9230s  CALL  FMNUL(RPI(LEL),CTL(LPI12),NRD,NND,NRD,RPI(LEE) ) 

9240s  CALL  FMADD(RPI(LEE) ,CTL(LPI22),NRD,NRD,RPI(LEE) ) 

9250s  CALL  MATLST(RPI(LGC1),NRD,NND,'*GC1",KLIST) 

9260s  CALL  MATLST ( RPI ( LGC 1 ) , NRD , NND, ”GC 1 " , KTERM) 

9270s  CALL  MATLST (RPI(LGC2 ), NRD, NRD, MGC2",KLIST) 

9280s  CALL  MATLST(RPI(LGC2), NRD, NRD, "GC2", KTERM) 

9290s  CALL  MATLST(RPI(LEE) , NRD, NRD, "E" ,KLIST) 

9300s  IF(NODY.EQ.1)GO  TO  15 

9310s  CALL  FMMUL(RPI(LEE),DM(LDY),NRD,NRD,NRD,ZMl ) 

9320s  CALL  SUBI(ZM1,NRD,NRD) 

9330s  NR2sNRD*NRD 

9340s  DO  12  Is1,NR2 

9350s  12  ZMl (I)s-ZMl (I) 

9360s  NDIMsNRD 

9370s  NDIMlsNDIM+1 

9380s  CALL  GMINV(NRD,NRD,ZMl,ZM2,MR, 1 ) 

9390s  CALL  FMMUL(ZM2,RPI(LEE),NRD,NRD,NRD,ZM1 ) 

9400s  CALL  MATLST(ZM1,NRD,NRD,"KP",KLIST) 

9410s  CALL  FMMUL(ZM2,RPI(LGC2),NRD,NRD,NRD,ZM1) 

9420s  CALL  MATLST(ZM1 ,NRD,NRD, "KI" ,KLIST) 

9430s  GO  TO  20 

9440s  15  MRITE(KLIST,103) 

9450s  103  FORMAT ("OKP  s  E  AND  KI  s  GC2") 

9460s  20  CONTINUE _ 

9470s  CALL  FMMUL(COMl ,CTL(LPI12),NRD,NND,NRD,ZM2) 

9480s  CALL  FTMTX (CM(LPHC),ZM1, NNC , NNC ) 

9490s  CALL  SUBI (ZMl, NNC , NNC ) 

9500s  NR2sNNC*NNC 

9510s  DO  25  Is1,NR2 

9520=  25  ZMl(I)s-ZMKl) 

9530s  NDIMsNNC 

9540s  NDIMlsNDIM+1 

9550s  CALL  GMINV(NNC,NNC,ZM1 ,C0M1,MR, 1 ) 

9560s  CALL  FMMUL ( CM( LCC ) , COM 1 , NPC , NNC , NNC , ZMl ) 

9570s  CALL  FMMUL ( ZMl , CM( LBDC ) , NPC , NNC , NRC , COM 1 ) 

9580s  CALL  FMADD(C0M1,CM(LDC) , NPC, NRC, ZMl ) 

9590s  CALL  FMMUL(ZM2,ZM1,NRD,NRD,NRC,RPI(LEL) ) 

9600a  LFLRPIsI 

9610s  LFLCGTsO 

9620s  RETURN 

9630sC  END  SUBROUTINE  SREGPI 


9640* 


END 


11110*  SUBROUTINE  SCGT 

11120=  COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL , LABORT 

11130*  COMMON/FILES/KSAVE , KDATA, KPLOT , KLIST, KTERM 

11140*  C0MM0N/ZMTX1/NVZM,ZM1(1) 

11150*  C0MM0N/ZMTX2/ZM2O) 

11160*  COWfON/NDIMD/NND,  NRD, NPD,NMD, NDD, NWD , NWDD, NPLD, NWPNWD, NNPR 

11170*  COMMON/ND IMC/NNC , NRC , NPC 

1 1 1 60*  COMMON/CMDMTX/NVCM, NEWCM, NODC , CM( 1 ) 

11190*  COMMON/LREGPI/LXDW , LUDW , LPHCL , LGC 1 , LGC2 , LEL , LEE 

11200*  COMMON/CREGPI/NVRPI,RPI( 1 ) 

11210*  COMMON/LC  GT/LA 1 1 , LA 1 3  #  LA2 1 , LA23 , LA 1 2 , LA22 , LELA 1 1 , LELA 1 2 , LELA 1 3 

11220*  C0MM0N/CCGT/NVCGT,CGT(1) 

11230*  IF (NEWCM)  20,20*15 

11240*  15  NSIZE* ( NND+2  *NPD ) * ( NNC+NRC+NDD ) 

11250*  IF(NSIZE.LE.NVCGT)  GO  TO  1 6 

11260*  WRITE  106, NSIZE 

11270*  LABORTsNSIZE 

1 1280*  RETURN 

11290*  16  IF(NND.GE.NNC)  GO  TO  17 

11300=  WRITE  107 

11310*  GO  TO  18 

11320*  17  IF(NND.GE.NDD)  GO  TO  19 

11330*  WRITE  108 

11340=  18  LABORT*- 1 

11350*  RETURN 

11360*  19  NEWCM* 0 

11370=  LA 11=1 

11380=  LA13*LA1 1+NND*NNC 

11390*  LA21*LA13+NND«NDD 

1 1400*  LA23sLA21+NPD*NNC 

11410*  LA 1 2=LA23+NPD*NDD 

11420*  LA22*LA12-*-NND*NRC 

11430*  LELA1 1 =LA22+NPD*NRC 

11440*  LELA 12*LELA 1 1 +NPD*NNC 

11450*  LELA13sLELA12't-NPD*NRC 

11460=  CALL  CGTA(CGT(LAU),CGT(LA13),CGT(LA21),CGT(LA23)»CGT(LA12), 

11470*  1  CGT (LA22 ) , ZM1 , ZM2 ) 

11480*  20  CALL  C0TKX(CGT(LA11 ) ,CGT(LA13), CGT ( LA2 1 ) , CGT (LA23),CGT(LA12 


11490*  1  CGT(LA22),CGT(LELA11),CGT(LELA12),CGT(LELA13),RPI(LEL),RPI(LGC1)) 


11500*  LFLCGT* 1 

11510*  106  FORMAT( "OINSUFFICIENT  MEMORY  /CCGT/,  NEED:  ",I4) 

11520*  107  FORMAT ("OFEWER  DESIGN  MODEL  THAN  COMMAND  MODEL  STATES") 

11530*  108  FORMAT( "FEWER  DESIGN  MODEL  THAN  DISTURBANCE  MODEL  STATES") 

11540*  RETURN 

11550*C  END  SUBROUTINE  SCGT 

11560*  END 


* 


SUBROUTINE  CGTKX(A11,A13,A21,A23tA12,A22,RELA11,RELA12,RELAl3,REL, 
1  RGC) 


14100=  C0MM0N/MAIN1 /NDIM, NDIM1 , COMl ( 1 ) 

14110=  COMMON/FILES/KSAVE, KDATA , KPLOT , KLIST , KTERM 

14120=  COMMON/ND IMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

14130=  COMMON/ND IMC/NNC , NRC , NPC 

14140=  DIMENSION  All (1 ), A13( 1 ), A21 (1 ),A23(1 ),A12(1 ),A22( 1 ), 

f 14150=  1  RELA1 1 ( 1 ), RELA12( 1 ) , RELA13( 1 ) , REL( 1 ) ,RGC( 1 )  ] 

14160=  NDIMsNRD 

14170=  NDIMlsNDIM»1 _ 


fl 41 80= 

CALL  FMMUL(RGC,A11 ,NRD,NND,NNC,RELA1 1 )  1 

14190= 

14200= 

14210= 

CALL  MADD 1 (NRD, NNC , RELA 1 1 , A2 1 , RELA 11,1.) 
CALL  MATLST ( RELA 1 1 , NRD , NNC , "KXM" , KLIST ) 
CALL  MATLST ( R  ELA 1 1 , NRD , NNC , "KXM" , KTERM) 

114220= 

CALL  FMMUL(RGC.A12.NRD.NND.NRCrti&LAl2)  ) 

1 4230= 

CALL  MADD 1 ( NRD . NRC . RELA 1 2 . A22 , RELA 1 2 , 1 . ) 

Il4240= 

CALL  MADD1 (NRD.NRC,RELA12,REL,RELA12,-1 .)l 

14250= 

14260= 

14270= 

CALL  MATLST ( RELA 12 , NRD, NRC, "KXU" , KLIST) 
CALL  MATLST ( RELA 1 2 , NRD , NRC , "KXU" , KTERM) 
IF(NDD.LT.I)  RETURN 

1 14280= 

CALL  FMMUL(RGC,A13.NRD.NND.NDD.RELA13)  1 

14290=  CALL  MADD1 (NRD,NDD,RELA13,A23,RELAl3, 1 .) 

14300=  CALL  MATLST ( RELA 1 3 , NRD , NDD , "KXN" , KLIST ) 

14310=  CALL  MATLST ( RELA 1 3 , NRD , NDD , "KXN" , KTERM) 

14320=  RETURN 

14330=C  END  SUBROUTINE  CGTKX 

14340=  END 


4.JL 


r.~  *•-"  %  %  JV  .’v  -,  -  ■ t*  • 


c*3  Subroutine  Changes  for  CGT/PI  Formulation  3 

Subroutines  CTRESP,  UCGT,  SREGPI,  SCGT,  and  CGTKX 
were  changed  to  produce  the  program  based  on  CGT/PI 
formulation  3.  These  subroutines  are  listed  on  the 
following  pages.  Changed  lines  are  marked. 
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8700= 
8710= 
8720= 
8730= 
8740= 
8750= 
8760= 
8770= 
8780= 
8790= 
8800= 
8810= 
8820= 
8830= 
8840= 
8850=  110 
8860= 
8870= 
8880= 
8890=  101 
8900= 
8910=  5 
8920= 
8930= 
8940=  102 
8950=  8 
8960= 
8970=  10 
8980= 
8990= 
9000= 
9010= 
9020= 
9030= 
9040= 
9050= 
9060= 
9070= 
9080= 
9090s 
9100= 
9110= 
9120= 
9130= 
9140= 
9150= 
9160= 
9170= 
9180= 
19190= 
9200= 
9210= 
9220= 
9230= 


SUBROUTINE  SREGPI(IMPLIC) 

C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

COMMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , LFLKF , LTEVAL, LABORT 
COMMON/FILES/KSAVE , KDATA , KPLOT , KLIST , KTERM 
COMMON/SYSMTX/NVSM, SM( 1 ) 

COMMON/ZMTX 1 /NVZM, ZM1 ( 1 ) 

C0MK)N/ZMTX2/ZM2(  1 ) 

COMMON/ND IMD/NND , NRD , NPD , NMD , NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 
COMMON/LCNTRL/LPI 1 1 , LPIl 2 , LPI2 1 , LPI22 , LPHDL , LBDL 
COMMON/CONTROL/NVCTL, CTL( 1 ) 

COMMON/LREGPI/LXDW , LUDW, LPHCL, LGC 1 , LGC2 , L EL, LEE 
COMMON/CREGPI/NVRPI,RPI( 1 ) 

COMMON/LOCD/LAP, LGP , LPHI, LBD, LEX, LPHD, LQ, LQN, LQD, LC, LDY, LEY, LHP, LR 
COMMON/DSNMTX/NVDM, NODY, NOEY, DM( 1 ) 

WRITE ( KLIST, 1 10) 

F0RMAT(////1 IX, 5("*  "), "REG/PI  DESIGN* , 5 ( "  •")////) 

NSIZE=NRD* ( 5*NRD+2*NND) *NNPR»NNPR 
IF(NSIZE.LE.NVRPI)  GO  TO  5 
WRITE  101 ,NSIZE 

FORMAT(*OINSUFFICIENT  MEMORY  /CREGPI/,  NEED:  *,I4) 

GO  TO  8 

NSIZEsNNPR* ( 3#NNPR+NRD ) 

IF(NSIZE.LE.NVSM)  GO  TO  10 
WRITE  102,NSIZE 

F0RMAT("0INSUFFICIENT  MEMORY  /SYSMTX/,  NEED:  *,I4) 

LABORTsNSIZE 

RETURN 

LX=1 

LU=LX+NNPR*NNPR 

CALL  WXUS(SM(LX) , SM(LU) , C0M1 ,ZM1, ZM2, IMPLIC) 

LUIST=LU+NNPR*NRD 

LPHP=LUIST+NNPR*NNPR 

CALL  PXUP (CTL( LPHDL ) , CTL( LBDL) , SM(LX ) , SM( LU) , C0M1 , ZM2 , 

1  SM(LUIST) ,SM(LPHP) , SM(LX) , ZM1 ) 

CALL  DRIC ( NDIM, SM( LPHP ) , ZM2 , SM( LX ) , ZM 1 , RPI ( LPHCL ) ) 

CALL  GCSTAR (SM( LPHP ) , CTL( LBDL) , SM(LU) , ZMl , SM( LUIST) ,  SM( LX ) , ZM2 ) 
CALL  TFRMTX (RPI ( LGC 1 ) , SM( LX ) , NRD, NND , 1 ) 

L3=LADDR (NDIM, 1 , NND+1 )+LX-l 

CALL  TFRMTX (RPI ( LGC2 ) , SM( L3 ) , NRD, NRD, 1 ) 

L 1 sLADDR ( NNPR , NND+ 1 , NND* 1 ) 

L2=LADDR(NNPR, 1 ,NND+1 ) 

CALL  OH NV( NRD, NRD, ZMl (LI ) ,ZM1 (L2),MR, 1 ) 

LI =LADDR (NNPR, NND+1 , 1 ) 

CALL  MMUL(ZM1 (L2 ) , ZMl (L 1 ) , NRD, NRD, NND, ZMl ) 

CALL  MMUL(SM(L3) »ZMl,NRD,NRD,NND,ZMl (LI )) 

CALL  MADD1 (NRD,NND,SM(LX),ZM1 (L1),ZM1,-1 .) 

CALL  TFRMTX (RPI(LEL), ZMl, NRD, NND, 1) 

CALL  FMMUL(RPI(LEL),CTL(LPI12),NRD,NND,NRD,RPI(LEE) ) 

CALL  FMADD(RPKLEE) ,CTL(LPI22)»NRD,NRD,RPI(LEE) ) 

CALL  FTMTX(RPKLEE)  .RPI(LEL)  .NRD. NRD)  1 
CALL  MATLST(RPI(LGC1 ) , NRD, NND, "GC1" , KLIST) 

CALL  MATLST ( RPI ( LGC 1 ) , NRD , NND , "GC 1 " , KTERM) 

CALL  MATLST ( R PI ( LGC2 ) , NRD , NRD , *GC2" , KLIST ) 

CALL  MATLST ( RPI ( LGC2 ), NRD , NRD , *GC2" , KTERM) 
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9240*  CALL  MATLST(RPI(LEE),NRD,NRD,"E",KLIST) 

9250a  IF(N0DY.EQ.1)G0  TO  15 

9260a  CALL  FMMUL(RPI(LEE) , DM(LDY) , NRD, NRD, NRD, ZMl ) 

9270a  CALL  SUBI(ZMl,NRD,NRD) 

9280a  NR2aNRD»NRD 

9290a  DO  12  Ia1,NR2 

9300a  12  ZMKl)a-ZMl(I) 

9310a  NDIMaNRD 

9320a  NDIMlaNDIM+1 

9330a  CALL  01INV(NRD,NRD,ZM1,ZM2,MR,1) 

9340a  CALL  FMMUL(ZM2, RPI(LEE) , NRD*  NRD, NRD, ZMl ) 

9350a  CALL  MATLST(ZM1,NRD,NRD,”KP",KLIST) 

9360a  CALL  FMMUL(ZM2,RPI(LGC2),NRD,NRD,NRD,ZM1) 

9370a  CALL  MATLST ( ZM 1 , NRD , NRD , ”K I " , KL 1ST ) 

9380a  GO  TO  20 

9390a  15  WRITE(KLIST,103) 

9400a  103  FORMAT ("OKP  a  E  AND  KI  a  GC2") 

9410a  20  CONTINUE 

9420a  LFLRPIal 

9430a  LFLCGTaO 

9440a  RETURN 

9450aC  END  SUBROUTINE  SREGPI 


10930=  SUBROUTINE  SCGT 

1 0940a  COMMON/DESIGN/NVCOM, TSAMP, LFLRPI , LFLCGT , LFLKF , LTEVAL , LABORT 

1 0950a  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST , KTERM 

10960a  COMMON/ZMTXl/NVZM,ZMl(l) 

10970a  C0MM0N/ZMTX2/ZM2( 1 ) 

10980a  COMMON/NDIMD/NND , NRD, NPD , NMD , NDD , NHD , NWDD , NPLD , NWPNWD , NNPR 

10990a  COMMON/NDIMC/NNC,NRC,NPC 

1 1000a  COMMON/CMDMTX/NVCMy NEWCM, NODC, CM( 1 ) 

1 1010a  COMMON/LREGPI/LXDW, LODW , LPHCL, LGCl ,LGC2,LEL,LEE 

1 1020a  COMMON/CREGPI/NVRPI, RPI( 1 ) 

11030a  COMMON/LCGT/LA 1 1 , LA 1 3 , LA2 1 , LA23 , LA 1 2 , LA22 , LELA 1 1 , LELA 1 2 , LELA 1 3 

1 1040a  COMMON/CCGT/NVCGT,CGT( 1 ) 

11050a  IF (NEWCM)  20,20,15 

11060a  15  NSIZEa ( NND+2  *NPD ) * ( NNC+NRC+NDD ) 

11070a  IF ( NSIZE • LE • NVCGT )  GO  TO  16 

11080a  WRITE  106, NSIZE 

1 1090a  LABORTaNSIZE 

11100a  RETURN 

11110a  16  IF(NND.GE.NNC)  GO  TO  17 

11120a  WRITE  107 

11130a  GO  TO  18 

11140a  17  IF(NND.GE.NDD)  GO  TO  19 

11150a  WRITE  108 

11160a  18  LABORTa-1 

11170a  RETURN 

11180a  19  NEWCMaO 

11190a  LAllal 

11200a  LA13aLA11+NND*NNC 

11210a  LA21 aLA 1 3+NND*NDD 

11220a  LA23aLA2UNPD»NNC 


1 1 230:  LA 1 2=LA23+NPD*NDD 

11240:  LA22=LA12+NND*NRC 

11250:  LCLA 1 1 =LA22+NPD*NRC 

11260:  LELA12=LELA1UNPD«NNC 

11270:  LELA 1 3 :LELA 1 2+NPD*NRC 

11280:  CALL  CGTA(CGT(LA11),CGT(LA13),CGT(LA21),CGT(LA23),CGT(LA12), 

11290:  1  CGT(LA22),ZM1,ZM2) 

11300:  20  CALL  CGTKX(CCT(LA11),C0T(LA13),C0T(LA21).CGT(LA23).CGT(LA12). 
1l3l0=  1  CGT(LA22),CGT(LELA11),CGT(LELA12),CGT(LELA13),RPI(LGC1))  | 

11320:  LFLCGT:1 

11330:  106  F0RMAT("0INSUFFICIENT  MEMORY  /CCGT/,  NEED:  ",I4) 

11340:  107  FORMAT ("OF EWER  DESIGN  MODEL  THAN  COMMAND  MODEL  STATES") 

11350:  108  FORMAT ("FEWER  DESIGN  MODEL  THAN  DISTURBANCE  MODEL  STATES”) 

11360:  RETURN 

11370:C  END  SUBROUTINE  SCGT 

11380:  END 


13900:  SUBROUTINE  CGTKX(A11,A13,A21,A23,A12,A22,RELA11.RELA12,RELA13,RCC) 

13910:  C0MM0N/MAIN1 /NDIM, NDIM1 , C0M1 ( 1 ) 

1 3920:  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

1 3930:  COMMON/ND IMD/NND, NRD, NPD,NMD, NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

13940:  COMMON/NDIMC/NNC , NRC , NPC 

13950:  DIMENSION  All (1 ),A13( 1 ),A21 (1 ),A23(1 ),A12(1 ).A22(1 ), 

13960:  1  RELA11(1).RELA12(1)»RELA13(1)»RGC(1) 1 

13970:  NDIM: NRD 

13980:  NDIM1:NDIM+1 _ 

113990=  CALL  FMMUL(RGC,A11tNRD,NND,NNC,RELA11)l 

14000:  CALL  MADD1 (NRD,NNC, RELA1 1 ,A21 » RSLA11 , 1 .) 

14010=  CALL  MATLST (RELA 11, NRD ,NNC,"KXM", KLIST) 

14020:  CALL  MATLST ( RELA 11, NRD, NNC , "KXM" , KTERM) 

114030:  CALL  FMMUL(RGC.A12.NRD.NND,MRC,RELA12)  1 

14040=  CALL  MADD1 (NRD,NRC,RELA12,A22,RELA12, 1 •) 

14050:  CALL  MATLST (RELA 12, NRD, NRC, "KXU", KLIST) 

14060=  CALL  MATLST(RELA12,NRD,NRC, "KXU", KTERM) 

14070:  IF(NDD.LT.I)  RETURN _ 

1 1 4080=  CALL  FMMUL(RGC.A13.NRD.NND,NDD,RELA13)  1 

14090=  CALL  MADD1(NRD,NDD,RELAl3tA23»RELA13, 1*) 

14100:  CALL  MATLST (RELA 1 3 , NRD , NDD , "KXN" , KLIST ) 

14110:  CALL  MATLST ( R ELA 13, NRD, NDD, "KXN", KTERM) 

14120:  RETURN 

14130=C  END  SUBROUTINE  CGTKX 
14140:  END 


16620:  SUBROUTINE  CTRESP(VXO,VX1,XO,X1,XMO,XM1,ZM1,NVOUT,TEND,IUM,VUM, 

16630:  1  NST) 

1 6640:  COMMON/D  ESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT, LFLKF, LTEVAL, LABORT 

1 6650=  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

16660:  COMMON/ND IMD/NND , NRD , NPD , NMD, NDD , NWD , NWDD , NPLD , NWPNWD , NNPR 

1 6670:  COMMON/LOCD/LAP , LGP , LPHI , LBD , LEX , LPHD , LQ , LQN , LQD, LC , LDY , LEY , LHP , LR 

1 6680:  COMMON/DSNMTX/NVDM, NODY, NOEY, DM( 1 ) 

16690:  COMMON/NDIMC/NNC, NRC, NPC 

16700:  COMMON/LOCC/LPHC , LBDC , LCC , LDC 
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16710s  COMMON/CMDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

1 6720*  COMMON/LOCT/LPHT, LBDT, LQDT, LHT, LRT, LTDT.LTNT 

>  .  1 6730s  COMMON/TRUMTX/NVTM, TM( 1 ) 

16740s  COMMON/LREGPI/LXDW ,  LUDW , LPHCL ,  LGC 1 ,  LGC2 ,  LEL ,  LEE 

16750s  COHMON/CREGPI/NVRPIf RPI( 1 ) 

16760s  DIMENSION  VXO( 1 ), VX1 ( 1 ),X0( 1 ),X1 (1 ),XM0(1 ),XM1 (1 ),ZM1 (1 ) 

16770s  NSTPOs.01*TEND/TSAMP+.5 

16780s  NSTs2 

16790s  IF(NSTPO.GE.I)  GO  TO  1 


0 


16800s 

16810s 

16820s  i 

16830s 

16840s 

16850s 

16860s 

16870s 

16880s  2 

16890s  4 
16900s  5 

16910s 
16920s 
16930s 
16940s  6 
16950s  7 
16960s 
16970s  10 
16980s  12 

16990s 
17000= 
17010= 
17020= 
17030s 
17040= 
17050= 
17060= 
17070= 


17080=  15 
17090= 


NSTPOs 1 
NSTsI 

NSTEPSs 1 00*NSTP0 

IF(LFLCGT.EQ.O)  GO  TO  2 

LMO=NVOUT-NPC 

IF(NDD.EQ.O)  GO  TO  4 

LDCGTsI 

GO  TO  5 

LMOsNVOUT 

LDCGTsO 

LUsLMO-NRD 

LSO=LO-NPD 

NVXsLSO-1 

IF(LTEVAL)6,6,10 

DO  7  1=1, NVX 

X1(I)=VX1(I) 

GO  TO  12 

CALL  XFDT(VX1,X1,LDCGT) 

NNDP1=NND-f1 
REWIND  KPLOT 

CALL  YDSN(X1 , VX1 (LU) , DM(LC ) ,DM(LDY) , LDCGT, VX1 (LSO) ) 
IF(LFLCGT.EQ.I)  CALL  YCMD(XM1,IUM,VUM,CM(LCC),CM(LDC), 

1  VX1 (LMO) ) 

CALL  WPL0TF(VX1 ,NVOUT) 

DO  100  IT= 1 , NSTEPS 

CALL  HRPI(RPI(LGC1 ) ,RPI(LGC2) ,DM(LC) ,DM(LDY) , X0,X1 ,VXO(LU) , 
1  VXI(LU)) 

IF(LFLCGT)  20,20,15 


1 7100s 
17110=  20 
17120= 
17130s 
17140=  25 
17150= 
17160= 
17170=  30 
17180= 
17190*  35 
17200= 
17210= 
17220= 
17230= 
17240* 
17250=  100 


CALL  0CGT( VXO (LO) ,7X1 (LO) , XMO, XMl ,X0 (NNDP1 ) ,ZM1 , IUM, VUM, IT, 
1  VX1 (LMO) ) 

CALL  CUPDAT ( XMO , XM 1 , IUM, VUM) 


CALL  FTMTX(VX1 (LU) , VXO (LU) , NRD, 1 ) 

CALL  FTMTX(X1 ,XO,NPLD, 1 ) 

IF(LTEVAL)  25,25,30 

CALL  DUPDAT(DM(LPHI) , DM(LBD) , DM(LPHD) , DM(LEX), XO, XI , 

1  VX1,VX0(LU), LDCGT, NNDP1) 

GO  TO  35 

CALL  TUPDAT(TM(LPHT) , TM(LBDT) , VXO, VX1 , VXO(LU) ) 

CALL  XFDT(VX1, XI, LDCGT) 

IF(MOD(IT,NSTPO) .NE.O)  GO  TO  100 
VX1 (NVOUT)*TSAMP«FLOAT(IT) 

CALL  YDSN(X1 , VX1 (LU) , DM(LC) , DM(LDY) , LDCGT, VX1 (LSO) ) 
IF(LFLCGT.EQ.I)  CALL  YCMD(XM1,IUM,VUM,CM(LCC),CM(LDC), 
1  VXI(LMO)) 

CALL  WPLOTF ( VX 1 , NVOUT ) 

CONTINUE 
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17260*  ENDFILE  KPLOT 
17270s  RETURN 

17280sC  END  SUBROUTINE  CTRESP 
17290s  END 


*  *1 


18110s 
18120 


f8l30s 
18140s 
18150s  8 
18160s 


18180s 

18190s  12 

18200s 

18210s 

18220s 

18230s 

18240s  14 

18250s 

18260s 

l8270sC  END 


•XMl.DDIF.ZMl.IUM.VUM.IT, YC 


INl/NDIM,NDIMl,COMl (1 
COMMON/ND IMD/NND, NRD , NPD , NMD , NDD, NWD, NWDD , NPLD , NWPNWD , NNPR 
COMfON/NDIMC/NNC , NRC , NPC 
COMMON/LOCC/LPHC , LB DC , LCC , LDC 
COMMON/CMDMTX/NVCM, NEWCM, NODC,CM( 1 ) 

COMMON/LREGPI/LXDW, LUDW, LPHCL, LGC 1 , LGC2, LEL, LEE 
COMMON/CREGPI/NVRPI ,  RPI ( 1 ) 

COMMON/LCGT/LA 1 1 , LA 1 3 , LA2 1 , LA23 , LA 1 2 , LA22 , LELA 1 1 , LELA 1 2 , LELA 1 3 
COMMON/CCGT/NVCGT, CGT( 1 ) 

DIMENSION  U0(1),U1(1),XM0(1),XM1(1),DDIF(1),ZM1(1) 

CALL  YCMD(XM0.IUM.7UM.CM(LCC1 .CM(LDC) .UP) 

IF(IT«GT. 1 )  GO  TO  8  1 
I sLELA 1 2+LADDR ( NPD , 1 , IUM) -1 
CALL  MADD1 (NPD, 1,U1,CGT(I),U1,VUM 


CALL  MMULS(RPI(LEL) , UO, NDIM, NDIM, 1 ,  U1 ) 
GO  TO  10 

CALL  MADD1 (NPD, 1, YC,UO, YC,-1 .) 

CALL  MMULS(RPI(LEL).YC.NDIM.NDIM.1,U1 


ALL  MfULS(RPI(LGC2),U0,NDIM,NDIM,1,Ul) 
DO  12  I=1,NNC 
XM0(I)sXM1 (I)-XMO(I) 

CALL  FMMUL(CGT(LELA11),XMO,NPD,NNC,1,UO) 
CALL  VADD(NDIM,1.,U1,U0) 

IF(NDD.EQ.O)  RETURN 
DO  14  1*1, NDD 
DDIF ( I ) s-DDIF ( I ) 

CALL  MKULS(CGT(LELA13),DDIP,NPD,NDD,1,U1 
RETURN 

SUBROUTINE  UCGT 


C . 4  Subroutine  Changes  for  CGT/PI  Formulation  4 

Subroutines  SCGT  and  CGTKX  were  changed  to  produce 
the  program  based  on  CGT/PI  formulation  4.  These 
subroutines  are  listed  on  the  following  pages.  Changed 
lines  are  marked. 
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10920s  SUBROUTINE  SCGT 

1 0930s  COIMON/DESIGN/NVCOM, TSAMP , LFLRPI , LFLCGT , LFLKP , LTEVAL, LABORT 

1 0940s  COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERM 

10950s  C0MM0N/ZMTX1/NVZM,ZM1(1) 

1 0960s  C0MH0N/ZMTX2/ZM2 ( 1 ) 

1 0970s  COMMON/NDIMD/NND , NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 

10980s  COMMON/ND IMC/NNC ,NRC,NPC 

1 0990s  COMMON/CMDMTX/NVCM, NEWCM, NODC , CM( 1 ) 

1 1000s  COMMON/LREGPI/LXDW, LUDW, LPHCL, LGC 1 , LGC2 , LEL, LEE 

1 1010s  COMMON/CREGPI/NVRPI, RPI( 1 ) 

11020s  COMMON/LCGT/LA 1 1 , LA 1 3 , LA2 1 , LA2 3 » LA 1 2 , LA22 , LELA 1 1 , LELA 12, LELA 1 3 

1 1030s  COMMON/CCGT/NVCGT, CGT( 1 ) 

11040s  IF(NEWCM)  20,20,15 

11050s  15  NSIZEs(NND+2«NPD)»(NNC+NRC+NDD) 

11060s  IF ( NSIZE . LE . NVCGT )  GO  TO  16 

11070s  WRITE  106, NSIZE 

11080s  LABORTsNSIZE 

1 1090s  RETURN 

11100s  16  IF(NND.GE.NNC)  GO  TO  17 

11110s  WRITE  107 

11120s  GO  TO  18 

11130s  17  IF(NND.GE.NDD)  GO  TO  19 

11140s  WRITE  108 

11150s  18  LABORTs-1 

11160s  RETURN 

11170s  19  NEWCMsO 

11180s  LAIIsl 

11190s  LAl3sLA11+NND»NNC 

11200s  LA21sLA13+NND«NDD 

11210s  LA23=LA21+NPD*NNC 

11220s  LAI 2sLA23+NPD#NDD 

1 1 230s  LA22sLA1 2+NND»NRC 

1 1240s  LELA1 1 sLA22+NPD*NRC 

11250s  LELA12sLEU1UNPD*NNC 

11260s  LELA 1 3*LELA 1 2+NPD»NRC 

11270s  CALL  CGTA(CGT(LA11),CGT(LA13),CGT(LA21),CGT(LA23),CGT(LA12), 

11280s  1  CGT(LA22) ,ZM1 ,ZM2) 

11290s  20  CALL  CGTKX(CGT(LA11).CGT(LA13),CGT(LA21),CGT(LA23),CGT(LA12 ) , 


|  11300s 

11'3W 

11320s 

11330. 
11340. 
1 1350. 
11360 
1 1370 


1  CGT(LA22),CGT(LELA11 ),CGT(LELA12),CGT(LELA13).RPI(LGC1 ))  I 

LPCCWTi - -  - 

FORMAT ("©INSUFFICIENT  MEMORI  /CCGT/,  NEED:  ",I4) 

FORMAT ("OFEWER  DESIGN  MODEL  THAN  COMMAND  MODEL  STATES" ) 
FORMAT( "FEWER  DESIGN  MODEL  THAN  DISTURBANCE  MODEL  STATES") 
RETURN 

C  END  SUBROUTINE  SCGT 
END 


106 

107 

108 


•v-v 


1 13890s  SUBROUTINE  CQTKX(A11,A13.A21,A23,A12,A22,RELA11,RELA12,RBLA13,R0C)  ) 

13900.  COMMON/MAI N1 /NDIM, NDIM1 ,C0M1 ( 1 ) 


13900 

13910. 

13920s 

13930s 


C0M40N/FILES/ESA7E, KDATA, KPLOT, KLIST, KTERM 
COMMON/NDIMD/NND, NRD, NPD, NMD, NDD, NWD, NWDD, NPLD, NWPNWD, NNPR 
COMMON/ND  IMC/NNC , NRC , NPC 


i 


1 

1  13950s 

1  RELA1 1 (1 )f RELA12(1 ),RELA13( 1 )»RGC( 1 )  I 

13960s 

13970* 

NDIMsNRD 

NDIM1sNDIM+1 

113980= 

CALL  FMMUL ( RGC , All , NRD , NND , NNC , RELA 11)1 

13990s 

14000s 

14010* 

CALL  MADD 1 ( NRD , NNC , RELA 1 1 , A2 1 , RELA 1 1 , 1 7) 
CALL  MATLST ( R  ELA 1 1 , NRD , NNC , "K XM" , KLIST ) 
CALL  MATLST (RELA1 1 .NRD.NNC. "KXM" , KTERM) 

ll  4020s 

CALL  FMMUL (ROC. A12* NRD. NND.NRC>RELA12)  | 

14030s 

14040s 

14050s 

14060s 

CALL  MADD 1 ( NRD, NRC , RELA 1 2 , A22 , RELA 1 2 , 1 . ) 
CALL  MATLST (RELA 12, NRD, NRC, *KXU" , KLIST) 
CALL  MATLST ( RELA 1 2 , NRD , NRC , "KXU" , KTERM) 
IF(NDD.LT.I)  RETURN 

1 14070s 

CALL  FMMUL(RGC,A13,NRD,NND,NDD,RELA13) 1 

14080s 

14090s 

14100s 

14110s 


CALL  MATLST (RELA13,NRD,NDD, "KXN" , KLIST) 
CALL  MATLST ( RELA 1 3 , NRD , NDD , "KXN" , KTERM) 
RETURN 


14120sC  END  SUBROUTINE  CGTKX 


14130s 


END 


D.l  Introduction 

CGT/PI/KF  design  actually  consists  of  three  separate 
designs:  the  controller  with  PI  control  action,  the 
open- loop  CGT  or  closed- loop  CGT/PI  controller,  and  the 
Kalman  filter.  Each  of  these  designs  is  best  evaluated 
according  to  criteria  specifically  related  to  the  task  that 
each  is  to  perform. 

For  the  controller,  relevant  considerations  include 


the  closed- loop  system  poles,  the  values  of  the  feedforward 
and/or  feedback  gains,  and  the  time  response  of  the 
controller  system  states,  output,  and  control  inputs  in 
either  unforced  or  forced  input  conditions.  For  the  filter, 
relevant  considerations  include  the  poles  of  the  filter,  the 
values  of  the  filter  gains,  and  the  filter's  estimation 


error  behavior.  An  overall  evaluation  of  the  system 
performance  for  the  CGT/PI/KF  closed  -loop  controller  is 


necessary  to  tune  the  entire  design  properly  and  judge  its 
ultimate  performance.  The  true  CGT/PI/KF  controller  will 
suffer  some  degree  of  degraded  performance  due  to  the 
dynamics  of  the  Kalman  filter's  state  estimation  and  also  a 
slightly  increased  delay  in  control  generation  due  to  the 
needed  filter  computations.  The  necessary  performance 
evaluation  software  for  this  entire  CGT/PI/KF  controller  is 
contained  in  the  program  "PFEVAL”  (Ref  21).  This  appendix 
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My- 


is  taken  from  Chapter  IV  of  Floyd's  thesis  (Ref  9) 


"J1  V 

D.2  PI  Controller  Evaluation 

The  discrete-time  poles  of  the  closed- loop  system 

* 

incorporating  the  optimal  gain  G  of  Equation 

c 

(II 1—52 )  and  assuming  perfect  state  knowledge  are  computed 
from  the  matrix 

IfCL  ‘  ‘*f  *  i/O  (D-1) 

with  and  Bf  as  defined  in  Equations  (III-42a)  and 
(III-42b) ,  respectively.  The  equivalent  continuous-time 
poles  are  then  computed  using  the  inverse  of  the  relation 
between  the  z  and  s  transforms 

£ 

ST 

z  »  e  (D— 2 ) 


in  which  z  and  s  are  respectively  the  discrete  and 
continuous-time  complex  poles  and  T  is  the  controller  sample 
period.  This  mapping  is  for  the  primary  strip  in  the 
s-plane  only  and  does  not  consider  any  possible  aliasing 
effects  (Ref  14) . 

Another  important  consideration  in  evaluating  the 

controller  design  is  the  magnitudes  of  the  gains 
*  * 

ficl  and  <*C2  ,  but  the  most  useful 
information  can  be  determined  from  the  system's  time 
response  to  initial  conditions  on  the  states.  The  time 
response  can  be  readily  simulated  using  the  discretized 
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deterministic  state  transition  equations  of  either  the 
design  or  the  truth  model  and  driven  by  the  control  input 


obtained  from  Equation  (III-75)  by  deleting  terms  due  to  the 
CGT  feedforward  control.  Note  that  this  controller  form  is 
valid  only  for  the  PI  controller  with  zero  reference  input 
*  0)  and  in  response  to  non-zero  initial  conditions 
on  the  states.  Plots  of  the  time  histories  of  the  states, 
the  outputs,  and  the  generated  control  inputs  then  may  be 
made.  These  allow  evaluation  of  the  quality  of  the 
regulation  achieved— speed  and  damping  of  the  state  and 
output  response,  and  the  magnitudes  and  rates  of  the  control 
inputs  actually  required. 

D.3  CGT  or  CGT/PI  Evaluation 

As  for  the  PI  controller  evaluation  discussed  above, 
consideration  of  the  magnitudes  of  the  feedforward  gains  may 
provide  useful  insights  into  the  CGT  design  results.  For 
the  open-loop  CGT  the  relevant  gains  are  acting  on 
the  command  model  states  and  £^3  actin9  on  the 
disturbance  states  in  the  open- loop  CGT  control  law 


u(ti)  =  +  ^21tsm(ti)  ” 

+  -  VVl*1 

+  A23^S<j(fci)  “  ( fc i— i )  1 


(D-4) 


obtained  from  Equation  (III-75)  by  setting  the  PI  controller 
*  * 

gains  and  to  zero.  For  the  CGT/PI 

controller  of  Equation  (III-75)  the  relevant  gains  are 


— xm  "  --11  +  -21 
&xu  “  — -12  +  ^22 
-xn  *  ——13  +  *23 


(D-5a) 

(D-5b) 

(D-5C) 


acting  on  the  command  model  states  and  inputs,  and 
disturbance  states,  respectively.  (See  Section  3.3.2  for 
changes  for  the  CGT/PI  formulations  2,3,4.) 


D . 4  Kalman  Filter  Evaluation 

Without  going  into  any  detail,  the  state  transition 
matrix  for  the  filter  estimate  propagation  is 


iKP  -  II  -  -F-.I— ; 


(D-6) 


The  filter's  discrete-time  poles  are  computed  as  the 
eigenvalues  of  »__  and  their  continuous- time  equivalents 

"KF 

computed  by  the  method  mentioned  in  Section  D.2.  The 
magnitudes  of  the  Kalman  filter  gains  may  be  evaluated  from 
the  standard  £_  matrix 
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The  greatest  insight  into  Kalman  filter  tuning  is 
provided  by  a  covariance  analysis  (Refs  11  and  17).  In  the 
covariance  analysis,  the  covariance  of  the  estimation  errors 
of  the  Kalman  filter  when  applied  to  the  system  truth  model 
is  propagated  forward  in  time  from  the  initial  conditions  on 
the  covariances  of  the  truth  model  states.  In  parallel  with 
this  estimate-error  covariance  propagation,  the 
filter-computed  covariance  is  itself  propagated  forward  in 
time.  The  true  and  filter  computed  estimation  error 
covariances  may  then  be  compared  since  the  truth  model  state 
estimation  error  covariances  can  be  transformed  to  errors 
for  the  design  states  using  Equation  (B-6c) .  The  designer 
may  then  modify  (tune)  the  dynamics  noise  and  measurement 
noise  strengths  to  achieve  the  desired  filter  performance: 
the  duration  of  the  initial  estimation  transient  and  the 
steady  state  error  covariance  obtained.  The  total 
development  of  this  is  given  in  Ref  (17)  and  summarized  in 


James  Page  McMillian  was  born  on  2  February  1947  in 
Clinton,  Missouri.  He  enlisted  in  the  Air  Force  in  June 
1970  and  received  training  as  an  Electronics  Technician  for 
the  Precision  Measuring  Equipment  Laboratories.  Assignments 
included  England  AFB,  La.,  Lowry  AFB ,  Colo.,  Barksdale  AFB , 
La.,  and  Bitburg  AFB,  Germany.  In  September  1977  he 
attended  Louisiana  Tech  University  under  the  Airman 
Education  and  Commissioning  Program,  graduating  in  December 
1977  with  a  degree  of  Bachelor  of  Science  in  Electrical 
Engineering.  During  his  undergraduate  education,  he  became 
a  member  of  Eta  Kappa  Nu  and  Tau  Beta  Pi.  He  received  his 
commission  from  Officer  Training  School  in  March  1980.  From 
March  1980  until  June  1982  he  was  assigned  to  HQ  Electronic 
Security  Command,  Kelly  AFB,  San  Antonio,  Texas.  He  entered 
the  School  of  Engineering  of  the  Air  Force  Institute  of 
Technology  in  June  1982  and  has  pursued  the  Guidance  and 
Control  curriculum  of  the  Electrical  Engineering  Department. 

Permanent  Address:  Rt.  1  Box  28A 

Calhoun,  Missouri  65323 


.  NAME  OF  FUNOING/3PONSORING 
ORGANIZATION 


Sc.  ADDRESS  (City,  Statu  and  ZIP  Coda) 


11.  TITLE  (tnciuda  Security  Clamifieation ) 

See  Box  19 


6.  PROCUREMENT  INSTRUMENT  IDENTIFICATION  NUMBER 

lio.  SOURCE  OF  FUNDING  NOS. 

PROGRAM 

PROJECT 

TASK 

WORK  UNI 

ELEMENT  NO. 

NO. 

NO. 

NO. 

12.  PERSONAL  AUTHOR(S) 

‘  James  P.  McMillian,  B.S.,  B.S.E.E.,  ILt,  USAF 


TYPE  OP  REPORT 

MS  Thesis 


16.  SUPPLEMENTARY  NOTATION 


13Hl  TIME  COVERBO 


14.  OATE  OP  REPORT  (Yr.,  Mo..  Day) 

1983  December 


IS.  PAGE  COUNT 

356 


SECURITY  CLASSIFICATION  OF  THIS  FACE 


This  study  develops  a  computer  program  for 
interactive  execution  to  aid  in  the  design  of  Command 
Generator  Tracker  control  systems  employing  Proportional 
Plus  Integral  inner  loop  controllers  based  on  the  integral 
of  the  regulation  error  and  Kalman  Filters  for  state 
estimation  (CGT/PI/KF  controllers) .  Sampled-data  controller 
designs  are  based  upon  the  Linear  system  model.  Quadratic 
cost,  and  Gaussian  noise  process  (LQG)  assumptions  of 
optimal  control  theory. 

The  report  develops  the  CGT/PI/KF  controller  theory 
with  the  PI  controller  portion  based  upon  the  integral  of 
the  regulation  error.  Following  a  brief  description  of  the 
computer  program  developed,  results  of  applying  it  to  an 
example  aircraft-related  controller  design  problem  is 
presented.  The  CGT/PI/KF  controller  is  found  to  be  a 
technique  particularly  well  suited  to  the  aircraft  control 
design  problem  but  is  a  technique  that  may  be  applied  to  any 
general  controller  problem  fitting  the  design  criteria. 

Use  of  the  computer  program  is  fully  documented  in 
the  appendices  of  the  report.  Included  are  a  brief 
"Programmer's  Manual,"  a  complete  "User's  Manual”,  and  a 
program  listing.  These  pertain  to  the  computer  program  as 
implemented  on  a  CDC  CYBER  computer  system. 
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